2 * Copyright (C) 2018 ARM Limited
3 * Copyright (C) 2015 Imagination Technologies
4 * Author: Alex Smith <alex.smith@imgtec.com>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published by the
8 * Free Software Foundation; either version 2 of the License, or (at your
9 * option) any later version.
11 #ifndef __ASM_VDSO_GETTIMEOFDAY_H
12 #define __ASM_VDSO_GETTIMEOFDAY_H
16 #include <linux/compiler.h>
17 #include <linux/time.h>
19 #include <asm/vdso/vdso.h>
20 #include <asm/clocksource.h>
22 #include <asm/unistd.h>
25 #define VDSO_HAS_CLOCK_GETRES 1
27 #define __VDSO_USE_SYSCALL ULLONG_MAX
30 #define VDSO_SYSCALL_CLOBBERS "hi", "lo",
32 #define VDSO_SYSCALL_CLOBBERS
35 static __always_inline long gettimeofday_fallback(
36 struct __kernel_old_timeval *_tv,
39 register struct timezone *tz asm("a1") = _tz;
40 register struct __kernel_old_timeval *tv asm("a0") = _tv;
41 register long ret asm("v0");
42 register long nr asm("v0") = __NR_gettimeofday;
43 register long error asm("a3");
47 : "=r" (ret), "=r" (error)
48 : "r" (tv), "r" (tz), "r" (nr)
49 : "$1", "$3", "$8", "$9", "$10", "$11", "$12", "$13",
50 "$14", "$15", "$24", "$25",
54 return error ? -ret : ret;
57 static __always_inline long clock_gettime_fallback(
59 struct __kernel_timespec *_ts)
61 register struct __kernel_timespec *ts asm("a1") = _ts;
62 register clockid_t clkid asm("a0") = _clkid;
63 register long ret asm("v0");
64 #if _MIPS_SIM == _MIPS_SIM_ABI64
65 register long nr asm("v0") = __NR_clock_gettime;
67 register long nr asm("v0") = __NR_clock_gettime64;
69 register long error asm("a3");
73 : "=r" (ret), "=r" (error)
74 : "r" (clkid), "r" (ts), "r" (nr)
75 : "$1", "$3", "$8", "$9", "$10", "$11", "$12", "$13",
76 "$14", "$15", "$24", "$25",
80 return error ? -ret : ret;
83 static __always_inline int clock_getres_fallback(
85 struct __kernel_timespec *_ts)
87 register struct __kernel_timespec *ts asm("a1") = _ts;
88 register clockid_t clkid asm("a0") = _clkid;
89 register long ret asm("v0");
90 #if _MIPS_SIM == _MIPS_SIM_ABI64
91 register long nr asm("v0") = __NR_clock_getres;
93 register long nr asm("v0") = __NR_clock_getres_time64;
95 register long error asm("a3");
99 : "=r" (ret), "=r" (error)
100 : "r" (clkid), "r" (ts), "r" (nr)
101 : "$1", "$3", "$8", "$9", "$10", "$11", "$12", "$13",
102 "$14", "$15", "$24", "$25",
103 VDSO_SYSCALL_CLOBBERS
106 return error ? -ret : ret;
109 #if _MIPS_SIM != _MIPS_SIM_ABI64
111 #define VDSO_HAS_32BIT_FALLBACK 1
113 static __always_inline long clock_gettime32_fallback(
115 struct old_timespec32 *_ts)
117 register struct old_timespec32 *ts asm("a1") = _ts;
118 register clockid_t clkid asm("a0") = _clkid;
119 register long ret asm("v0");
120 register long nr asm("v0") = __NR_clock_gettime;
121 register long error asm("a3");
125 : "=r" (ret), "=r" (error)
126 : "r" (clkid), "r" (ts), "r" (nr)
127 : "$1", "$3", "$8", "$9", "$10", "$11", "$12", "$13",
128 "$14", "$15", "$24", "$25",
129 VDSO_SYSCALL_CLOBBERS
132 return error ? -ret : ret;
135 static __always_inline int clock_getres32_fallback(
137 struct old_timespec32 *_ts)
139 register struct old_timespec32 *ts asm("a1") = _ts;
140 register clockid_t clkid asm("a0") = _clkid;
141 register long ret asm("v0");
142 register long nr asm("v0") = __NR_clock_getres;
143 register long error asm("a3");
147 : "=r" (ret), "=r" (error)
148 : "r" (clkid), "r" (ts), "r" (nr)
149 : "$1", "$3", "$8", "$9", "$10", "$11", "$12", "$13",
150 "$14", "$15", "$24", "$25",
151 VDSO_SYSCALL_CLOBBERS
154 return error ? -ret : ret;
158 #ifdef CONFIG_CSRC_R4K
160 static __always_inline u64 read_r4k_count(void)
164 __asm__ __volatile__(
176 #ifdef CONFIG_CLKSRC_MIPS_GIC
178 static __always_inline u64 read_gic_count(const struct vdso_data *data)
180 void __iomem *gic = get_gic(data);
184 hi = __raw_readl(gic + sizeof(lo));
185 lo = __raw_readl(gic);
186 hi2 = __raw_readl(gic + sizeof(lo));
189 return (((u64)hi) << 32) + lo;
194 static __always_inline u64 __arch_get_hw_counter(s32 clock_mode)
196 #ifdef CONFIG_CLKSRC_MIPS_GIC
197 const struct vdso_data *data = get_vdso_data();
201 switch (clock_mode) {
202 #ifdef CONFIG_CSRC_R4K
204 cycle_now = read_r4k_count();
207 #ifdef CONFIG_CLKSRC_MIPS_GIC
209 cycle_now = read_gic_count(data);
213 cycle_now = __VDSO_USE_SYSCALL;
220 static __always_inline const struct vdso_data *__arch_get_vdso_data(void)
222 return get_vdso_data();
225 #endif /* !__ASSEMBLY__ */
227 #endif /* __ASM_VDSO_GETTIMEOFDAY_H */