1c6b99bedSHuacai Chen /* SPDX-License-Identifier: GPL-2.0 */
2c6b99bedSHuacai Chen /*
3c6b99bedSHuacai Chen * Author: Huacai Chen <chenhuacai@loongson.cn>
4c6b99bedSHuacai Chen *
5c6b99bedSHuacai Chen * Copyright (C) 2020-2022 Loongson Technology Corporation Limited
6c6b99bedSHuacai Chen */
7c6b99bedSHuacai Chen #ifndef __ASM_VDSO_GETTIMEOFDAY_H
8c6b99bedSHuacai Chen #define __ASM_VDSO_GETTIMEOFDAY_H
9c6b99bedSHuacai Chen
10c6b99bedSHuacai Chen #ifndef __ASSEMBLY__
11c6b99bedSHuacai Chen
12c6b99bedSHuacai Chen #include <asm/unistd.h>
13c6b99bedSHuacai Chen #include <asm/vdso/vdso.h>
14c6b99bedSHuacai Chen
15c6b99bedSHuacai Chen #define VDSO_HAS_CLOCK_GETRES 1
16c6b99bedSHuacai Chen
gettimeofday_fallback(struct __kernel_old_timeval * _tv,struct timezone * _tz)17c6b99bedSHuacai Chen static __always_inline long gettimeofday_fallback(
18c6b99bedSHuacai Chen struct __kernel_old_timeval *_tv,
19c6b99bedSHuacai Chen struct timezone *_tz)
20c6b99bedSHuacai Chen {
21c6b99bedSHuacai Chen register struct __kernel_old_timeval *tv asm("a0") = _tv;
22c6b99bedSHuacai Chen register struct timezone *tz asm("a1") = _tz;
23c6b99bedSHuacai Chen register long nr asm("a7") = __NR_gettimeofday;
24c6b99bedSHuacai Chen register long ret asm("a0");
25c6b99bedSHuacai Chen
26c6b99bedSHuacai Chen asm volatile(
27c6b99bedSHuacai Chen " syscall 0\n"
28c6b99bedSHuacai Chen : "+r" (ret)
29c6b99bedSHuacai Chen : "r" (nr), "r" (tv), "r" (tz)
30c6b99bedSHuacai Chen : "$t0", "$t1", "$t2", "$t3", "$t4", "$t5", "$t6", "$t7",
31c6b99bedSHuacai Chen "$t8", "memory");
32c6b99bedSHuacai Chen
33c6b99bedSHuacai Chen return ret;
34c6b99bedSHuacai Chen }
35c6b99bedSHuacai Chen
clock_gettime_fallback(clockid_t _clkid,struct __kernel_timespec * _ts)36c6b99bedSHuacai Chen static __always_inline long clock_gettime_fallback(
37c6b99bedSHuacai Chen clockid_t _clkid,
38c6b99bedSHuacai Chen struct __kernel_timespec *_ts)
39c6b99bedSHuacai Chen {
40c6b99bedSHuacai Chen register clockid_t clkid asm("a0") = _clkid;
41c6b99bedSHuacai Chen register struct __kernel_timespec *ts asm("a1") = _ts;
42c6b99bedSHuacai Chen register long nr asm("a7") = __NR_clock_gettime;
43c6b99bedSHuacai Chen register long ret asm("a0");
44c6b99bedSHuacai Chen
45c6b99bedSHuacai Chen asm volatile(
46c6b99bedSHuacai Chen " syscall 0\n"
47c6b99bedSHuacai Chen : "+r" (ret)
48c6b99bedSHuacai Chen : "r" (nr), "r" (clkid), "r" (ts)
49c6b99bedSHuacai Chen : "$t0", "$t1", "$t2", "$t3", "$t4", "$t5", "$t6", "$t7",
50c6b99bedSHuacai Chen "$t8", "memory");
51c6b99bedSHuacai Chen
52c6b99bedSHuacai Chen return ret;
53c6b99bedSHuacai Chen }
54c6b99bedSHuacai Chen
clock_getres_fallback(clockid_t _clkid,struct __kernel_timespec * _ts)55c6b99bedSHuacai Chen static __always_inline int clock_getres_fallback(
56c6b99bedSHuacai Chen clockid_t _clkid,
57c6b99bedSHuacai Chen struct __kernel_timespec *_ts)
58c6b99bedSHuacai Chen {
59c6b99bedSHuacai Chen register clockid_t clkid asm("a0") = _clkid;
60c6b99bedSHuacai Chen register struct __kernel_timespec *ts asm("a1") = _ts;
61c6b99bedSHuacai Chen register long nr asm("a7") = __NR_clock_getres;
62c6b99bedSHuacai Chen register long ret asm("a0");
63c6b99bedSHuacai Chen
64c6b99bedSHuacai Chen asm volatile(
65c6b99bedSHuacai Chen " syscall 0\n"
66c6b99bedSHuacai Chen : "+r" (ret)
67c6b99bedSHuacai Chen : "r" (nr), "r" (clkid), "r" (ts)
68c6b99bedSHuacai Chen : "$t0", "$t1", "$t2", "$t3", "$t4", "$t5", "$t6", "$t7",
69c6b99bedSHuacai Chen "$t8", "memory");
70c6b99bedSHuacai Chen
71c6b99bedSHuacai Chen return ret;
72c6b99bedSHuacai Chen }
73c6b99bedSHuacai Chen
__arch_get_hw_counter(s32 clock_mode,const struct vdso_data * vd)74c6b99bedSHuacai Chen static __always_inline u64 __arch_get_hw_counter(s32 clock_mode,
75c6b99bedSHuacai Chen const struct vdso_data *vd)
76c6b99bedSHuacai Chen {
77c6b99bedSHuacai Chen uint64_t count;
78c6b99bedSHuacai Chen
79c6b99bedSHuacai Chen __asm__ __volatile__(
80c6b99bedSHuacai Chen " rdtime.d %0, $zero\n"
81c6b99bedSHuacai Chen : "=r" (count));
82c6b99bedSHuacai Chen
83c6b99bedSHuacai Chen return count;
84c6b99bedSHuacai Chen }
85c6b99bedSHuacai Chen
loongarch_vdso_hres_capable(void)86c6b99bedSHuacai Chen static inline bool loongarch_vdso_hres_capable(void)
87c6b99bedSHuacai Chen {
88c6b99bedSHuacai Chen return true;
89c6b99bedSHuacai Chen }
90c6b99bedSHuacai Chen #define __arch_vdso_hres_capable loongarch_vdso_hres_capable
91c6b99bedSHuacai Chen
__arch_get_vdso_data(void)92c6b99bedSHuacai Chen static __always_inline const struct vdso_data *__arch_get_vdso_data(void)
93c6b99bedSHuacai Chen {
94*aa5e65dcSTiezhu Yang return (const struct vdso_data *)get_vdso_data();
95c6b99bedSHuacai Chen }
96c6b99bedSHuacai Chen
97*aa5e65dcSTiezhu Yang #ifdef CONFIG_TIME_NS
98*aa5e65dcSTiezhu Yang static __always_inline
__arch_get_timens_vdso_data(const struct vdso_data * vd)99*aa5e65dcSTiezhu Yang const struct vdso_data *__arch_get_timens_vdso_data(const struct vdso_data *vd)
100*aa5e65dcSTiezhu Yang {
101*aa5e65dcSTiezhu Yang return (const struct vdso_data *)(get_vdso_data() + VVAR_TIMENS_PAGE_OFFSET * PAGE_SIZE);
102*aa5e65dcSTiezhu Yang }
103*aa5e65dcSTiezhu Yang #endif
104c6b99bedSHuacai Chen #endif /* !__ASSEMBLY__ */
105c6b99bedSHuacai Chen
106c6b99bedSHuacai Chen #endif /* __ASM_VDSO_GETTIMEOFDAY_H */
107