| OLD | NEW |
| 1 #include <time.h> | 1 #include <time.h> |
| 2 #include <errno.h> | 2 #include <errno.h> |
| 3 #include <stdint.h> | 3 #include <stdint.h> |
| 4 #include "syscall.h" | 4 #include "syscall.h" |
| 5 #include "libc.h" | 5 #include "libc.h" |
| 6 #include "atomic.h" | 6 #include "atomic.h" |
| 7 | 7 |
| 8 static int sc_clock_gettime(clockid_t clk, struct timespec *ts) | 8 #ifdef VDSO_CGT_SYM |
| 9 |
| 10 void *__vdsosym(const char *, const char *); |
| 11 |
| 12 static void *volatile vdso_func; |
| 13 |
| 14 static int cgt_init(clockid_t clk, struct timespec *ts) |
| 9 { | 15 { |
| 10 » int r = __syscall(SYS_clock_gettime, clk, ts); | 16 » void *p = __vdsosym(VDSO_CGT_VER, VDSO_CGT_SYM); |
| 11 » if (!r) return r; | 17 » int (*f)(clockid_t, struct timespec *) = |
| 18 » » (int (*)(clockid_t, struct timespec *))p; |
| 19 » a_cas_p(&vdso_func, (void *)cgt_init, p); |
| 20 » return f ? f(clk, ts) : -ENOSYS; |
| 21 } |
| 22 |
| 23 static void *volatile vdso_func = (void *)cgt_init; |
| 24 |
| 25 #endif |
| 26 |
| 27 int __clock_gettime(clockid_t clk, struct timespec *ts) |
| 28 { |
| 29 » int r; |
| 30 |
| 31 #ifdef VDSO_CGT_SYM |
| 32 » int (*f)(clockid_t, struct timespec *) = |
| 33 » » (int (*)(clockid_t, struct timespec *))vdso_func; |
| 34 » if (f) { |
| 35 » » r = f(clk, ts); |
| 36 » » if (!r) return r; |
| 37 » » if (r == -EINVAL) return __syscall_ret(r); |
| 38 » » /* Fall through on errors other than EINVAL. Some buggy |
| 39 » » * vdso implementations return ENOSYS for clocks they |
| 40 » » * can't handle, rather than making the syscall. This |
| 41 » » * also handles the case where cgt_init fails to find |
| 42 » » * a vdso function to use. */ |
| 43 » } |
| 44 #endif |
| 45 |
| 46 » r = __syscall(SYS_clock_gettime, clk, ts); |
| 12 if (r == -ENOSYS) { | 47 if (r == -ENOSYS) { |
| 13 if (clk == CLOCK_REALTIME) { | 48 if (clk == CLOCK_REALTIME) { |
| 14 __syscall(SYS_gettimeofday, ts, 0); | 49 __syscall(SYS_gettimeofday, ts, 0); |
| 15 ts->tv_nsec = (int)ts->tv_nsec * 1000; | 50 ts->tv_nsec = (int)ts->tv_nsec * 1000; |
| 16 return 0; | 51 return 0; |
| 17 } | 52 } |
| 18 r = -EINVAL; | 53 r = -EINVAL; |
| 19 } | 54 } |
| 20 » errno = -r; | 55 » return __syscall_ret(r); |
| 21 » return -1; | |
| 22 } | |
| 23 | |
| 24 void *__vdsosym(const char *, const char *); | |
| 25 | |
| 26 int __clock_gettime(clockid_t clk, struct timespec *ts) | |
| 27 { | |
| 28 #ifdef VDSO_CGT_SYM | |
| 29 » static int (*volatile cgt)(clockid_t, struct timespec *); | |
| 30 » if (!cgt) { | |
| 31 » » void *f = __vdsosym(VDSO_CGT_VER, VDSO_CGT_SYM); | |
| 32 » » if (!f) f = (void *)sc_clock_gettime; | |
| 33 » » a_cas_p(&cgt, 0, f); | |
| 34 » } | |
| 35 » return cgt(clk, ts); | |
| 36 #else | |
| 37 » return sc_clock_gettime(clk, ts); | |
| 38 #endif | |
| 39 } | 56 } |
| 40 | 57 |
| 41 weak_alias(__clock_gettime, clock_gettime); | 58 weak_alias(__clock_gettime, clock_gettime); |
| OLD | NEW |