1
2
3
4
5
6
7
8
9
10#ifndef __ASM_VDSO_GETTIMEOFDAY_H
11#define __ASM_VDSO_GETTIMEOFDAY_H
12
13#ifndef __ASSEMBLY__
14
15#include <uapi/linux/time.h>
16#include <asm/vgtod.h>
17#include <asm/vvar.h>
18#include <asm/unistd.h>
19#include <asm/msr.h>
20#include <asm/pvclock.h>
21#include <clocksource/hyperv_timer.h>
22
23#define __vdso_data (VVAR(_vdso_data))
24#define __timens_vdso_data (TIMENS(_vdso_data))
25
26#define VDSO_HAS_TIME 1
27
28#define VDSO_HAS_CLOCK_GETRES 1
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45#ifdef CONFIG_PARAVIRT_CLOCK
46
47
48
49
50
51extern struct pvclock_vsyscall_time_info pvclock_page
52 __attribute__((visibility("hidden")));
53#endif
54
55#ifdef CONFIG_HYPERV_TIMER
56extern struct ms_hyperv_tsc_page hvclock_page
57 __attribute__((visibility("hidden")));
58#endif
59
60#ifdef CONFIG_TIME_NS
61static __always_inline
62const struct vdso_data *__arch_get_timens_vdso_data(const struct vdso_data *vd)
63{
64 return __timens_vdso_data;
65}
66#endif
67
68#ifndef BUILD_VDSO32
69
70static __always_inline
71long clock_gettime_fallback(clockid_t _clkid, struct __kernel_timespec *_ts)
72{
73 long ret;
74
75 asm ("syscall" : "=a" (ret), "=m" (*_ts) :
76 "0" (__NR_clock_gettime), "D" (_clkid), "S" (_ts) :
77 "rcx", "r11");
78
79 return ret;
80}
81
82static __always_inline
83long gettimeofday_fallback(struct __kernel_old_timeval *_tv,
84 struct timezone *_tz)
85{
86 long ret;
87
88 asm("syscall" : "=a" (ret) :
89 "0" (__NR_gettimeofday), "D" (_tv), "S" (_tz) : "memory");
90
91 return ret;
92}
93
94static __always_inline
95long clock_getres_fallback(clockid_t _clkid, struct __kernel_timespec *_ts)
96{
97 long ret;
98
99 asm ("syscall" : "=a" (ret), "=m" (*_ts) :
100 "0" (__NR_clock_getres), "D" (_clkid), "S" (_ts) :
101 "rcx", "r11");
102
103 return ret;
104}
105
106#else
107
108static __always_inline
109long clock_gettime_fallback(clockid_t _clkid, struct __kernel_timespec *_ts)
110{
111 long ret;
112
113 asm (
114 "mov %%ebx, %%edx \n"
115 "mov %[clock], %%ebx \n"
116 "call __kernel_vsyscall \n"
117 "mov %%edx, %%ebx \n"
118 : "=a" (ret), "=m" (*_ts)
119 : "0" (__NR_clock_gettime64), [clock] "g" (_clkid), "c" (_ts)
120 : "edx");
121
122 return ret;
123}
124
125static __always_inline
126long clock_gettime32_fallback(clockid_t _clkid, struct old_timespec32 *_ts)
127{
128 long ret;
129
130 asm (
131 "mov %%ebx, %%edx \n"
132 "mov %[clock], %%ebx \n"
133 "call __kernel_vsyscall \n"
134 "mov %%edx, %%ebx \n"
135 : "=a" (ret), "=m" (*_ts)
136 : "0" (__NR_clock_gettime), [clock] "g" (_clkid), "c" (_ts)
137 : "edx");
138
139 return ret;
140}
141
142static __always_inline
143long gettimeofday_fallback(struct __kernel_old_timeval *_tv,
144 struct timezone *_tz)
145{
146 long ret;
147
148 asm(
149 "mov %%ebx, %%edx \n"
150 "mov %2, %%ebx \n"
151 "call __kernel_vsyscall \n"
152 "mov %%edx, %%ebx \n"
153 : "=a" (ret)
154 : "0" (__NR_gettimeofday), "g" (_tv), "c" (_tz)
155 : "memory", "edx");
156
157 return ret;
158}
159
160static __always_inline long
161clock_getres_fallback(clockid_t _clkid, struct __kernel_timespec *_ts)
162{
163 long ret;
164
165 asm (
166 "mov %%ebx, %%edx \n"
167 "mov %[clock], %%ebx \n"
168 "call __kernel_vsyscall \n"
169 "mov %%edx, %%ebx \n"
170 : "=a" (ret), "=m" (*_ts)
171 : "0" (__NR_clock_getres_time64), [clock] "g" (_clkid), "c" (_ts)
172 : "edx");
173
174 return ret;
175}
176
177static __always_inline
178long clock_getres32_fallback(clockid_t _clkid, struct old_timespec32 *_ts)
179{
180 long ret;
181
182 asm (
183 "mov %%ebx, %%edx \n"
184 "mov %[clock], %%ebx \n"
185 "call __kernel_vsyscall \n"
186 "mov %%edx, %%ebx \n"
187 : "=a" (ret), "=m" (*_ts)
188 : "0" (__NR_clock_getres), [clock] "g" (_clkid), "c" (_ts)
189 : "edx");
190
191 return ret;
192}
193
194#endif
195
196#ifdef CONFIG_PARAVIRT_CLOCK
197static u64 vread_pvclock(void)
198{
199 const struct pvclock_vcpu_time_info *pvti = &pvclock_page.pvti;
200 u32 version;
201 u64 ret;
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225 do {
226 version = pvclock_read_begin(pvti);
227
228 if (unlikely(!(pvti->flags & PVCLOCK_TSC_STABLE_BIT)))
229 return U64_MAX;
230
231 ret = __pvclock_read_cycles(pvti, rdtsc_ordered());
232 } while (pvclock_read_retry(pvti, version));
233
234 return ret;
235}
236#endif
237
238#ifdef CONFIG_HYPERV_TIMER
239static u64 vread_hvclock(void)
240{
241 return hv_read_tsc_page(&hvclock_page);
242}
243#endif
244
245static inline u64 __arch_get_hw_counter(s32 clock_mode,
246 const struct vdso_data *vd)
247{
248 if (likely(clock_mode == VDSO_CLOCKMODE_TSC))
249 return (u64)rdtsc_ordered();
250
251
252
253
254
255
256#ifdef CONFIG_PARAVIRT_CLOCK
257 if (clock_mode == VDSO_CLOCKMODE_PVCLOCK) {
258 barrier();
259 return vread_pvclock();
260 }
261#endif
262#ifdef CONFIG_HYPERV_TIMER
263 if (clock_mode == VDSO_CLOCKMODE_HVCLOCK) {
264 barrier();
265 return vread_hvclock();
266 }
267#endif
268 return U64_MAX;
269}
270
271static __always_inline const struct vdso_data *__arch_get_vdso_data(void)
272{
273 return __vdso_data;
274}
275
276static inline bool arch_vdso_clocksource_ok(const struct vdso_data *vd)
277{
278 return true;
279}
280#define vdso_clocksource_ok arch_vdso_clocksource_ok
281
282
283
284
285
286
287
288static inline bool arch_vdso_cycles_ok(u64 cycles)
289{
290 return (s64)cycles >= 0;
291}
292#define vdso_cycles_ok arch_vdso_cycles_ok
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312static __always_inline
313u64 vdso_calc_delta(u64 cycles, u64 last, u64 mask, u32 mult)
314{
315 if (cycles > last)
316 return (cycles - last) * mult;
317 return 0;
318}
319#define vdso_calc_delta vdso_calc_delta
320
321#endif
322
323#endif
324