| 1 |
#include <sys/timex.h> |
| 2 |
#include <time.h> |
| 3 |
#include <errno.h> |
| 4 |
#include "syscall.h" |
| 5 |
|
| 6 |
#define IS32BIT(x) !((x)+0x80000000ULL>>32) |
| 7 |
|
| 8 |
struct ktimex64 { |
| 9 |
unsigned modes; |
| 10 |
int :32; |
| 11 |
long long offset, freq, maxerror, esterror; |
| 12 |
int status; |
| 13 |
int :32; |
| 14 |
long long constant, precision, tolerance; |
| 15 |
long long time_sec, time_usec; |
| 16 |
long long tick, ppsfreq, jitter; |
| 17 |
int shift; |
| 18 |
int :32; |
| 19 |
long long stabil, jitcnt, calcnt, errcnt, stbcnt; |
| 20 |
int tai; |
| 21 |
int __padding[11]; |
| 22 |
}; |
| 23 |
|
| 24 |
struct ktimex { |
| 25 |
unsigned modes; |
| 26 |
long offset, freq, maxerror, esterror; |
| 27 |
int status; |
| 28 |
long constant, precision, tolerance; |
| 29 |
long time_sec, time_usec; |
| 30 |
long tick, ppsfreq, jitter; |
| 31 |
int shift; |
| 32 |
long stabil, jitcnt, calcnt, errcnt, stbcnt; |
| 33 |
int tai; |
| 34 |
int __padding[11]; |
| 35 |
}; |
| 36 |
|
| 37 |
int clock_adjtime (clockid_t clock_id, struct timex *utx) |
| 38 |
{ |
| 39 |
int r = -ENOSYS; |
| 40 |
#ifdef SYS_clock_adjtime64 |
| 41 |
struct ktimex64 ktx = { |
| 42 |
.modes = utx->modes, |
| 43 |
.offset = utx->offset, |
| 44 |
.freq = utx->freq, |
| 45 |
.maxerror = utx->maxerror, |
| 46 |
.esterror = utx->esterror, |
| 47 |
.status = utx->status, |
| 48 |
.constant = utx->constant, |
| 49 |
.precision = utx->precision, |
| 50 |
.tolerance = utx->tolerance, |
| 51 |
.time_sec = utx->time.tv_sec, |
| 52 |
.time_usec = utx->time.tv_usec, |
| 53 |
.tick = utx->tick, |
| 54 |
.ppsfreq = utx->ppsfreq, |
| 55 |
.jitter = utx->jitter, |
| 56 |
.shift = utx->shift, |
| 57 |
.stabil = utx->stabil, |
| 58 |
.jitcnt = utx->jitcnt, |
| 59 |
.calcnt = utx->calcnt, |
| 60 |
.errcnt = utx->errcnt, |
| 61 |
.stbcnt = utx->stbcnt, |
| 62 |
.tai = utx->tai, |
| 63 |
}; |
| 64 |
r = __syscall(SYS_clock_adjtime64, clock_id, &ktx); |
| 65 |
if (r>=0) { |
| 66 |
utx->modes = ktx.modes; |
| 67 |
utx->offset = ktx.offset; |
| 68 |
utx->freq = ktx.freq; |
| 69 |
utx->maxerror = ktx.maxerror; |
| 70 |
utx->esterror = ktx.esterror; |
| 71 |
utx->status = ktx.status; |
| 72 |
utx->constant = ktx.constant; |
| 73 |
utx->precision = ktx.precision; |
| 74 |
utx->tolerance = ktx.tolerance; |
| 75 |
utx->time.tv_sec = ktx.time_sec; |
| 76 |
utx->time.tv_usec = ktx.time_usec; |
| 77 |
utx->tick = ktx.tick; |
| 78 |
utx->ppsfreq = ktx.ppsfreq; |
| 79 |
utx->jitter = ktx.jitter; |
| 80 |
utx->shift = ktx.shift; |
| 81 |
utx->stabil = ktx.stabil; |
| 82 |
utx->jitcnt = ktx.jitcnt; |
| 83 |
utx->calcnt = ktx.calcnt; |
| 84 |
utx->errcnt = ktx.errcnt; |
| 85 |
utx->stbcnt = ktx.stbcnt; |
| 86 |
utx->tai = ktx.tai; |
| 87 |
} |
| 88 |
if (SYS_clock_adjtime == SYS_clock_adjtime64 || r!=-ENOSYS) |
| 89 |
return __syscall_ret(r); |
| 90 |
if ((utx->modes & ADJ_SETOFFSET) && !IS32BIT(utx->time.tv_sec)) |
| 91 |
return __syscall_ret(-ENOTSUP); |
| 92 |
#endif |
| 93 |
if (sizeof(time_t) > sizeof(long)) { |
| 94 |
struct ktimex ktx = { |
| 95 |
.modes = utx->modes, |
| 96 |
.offset = utx->offset, |
| 97 |
.freq = utx->freq, |
| 98 |
.maxerror = utx->maxerror, |
| 99 |
.esterror = utx->esterror, |
| 100 |
.status = utx->status, |
| 101 |
.constant = utx->constant, |
| 102 |
.precision = utx->precision, |
| 103 |
.tolerance = utx->tolerance, |
| 104 |
.time_sec = utx->time.tv_sec, |
| 105 |
.time_usec = utx->time.tv_usec, |
| 106 |
.tick = utx->tick, |
| 107 |
.ppsfreq = utx->ppsfreq, |
| 108 |
.jitter = utx->jitter, |
| 109 |
.shift = utx->shift, |
| 110 |
.stabil = utx->stabil, |
| 111 |
.jitcnt = utx->jitcnt, |
| 112 |
.calcnt = utx->calcnt, |
| 113 |
.errcnt = utx->errcnt, |
| 114 |
.stbcnt = utx->stbcnt, |
| 115 |
.tai = utx->tai, |
| 116 |
}; |
| 117 |
#ifdef SYS_adjtimex |
| 118 |
if (clock_id==CLOCK_REALTIME) r = __syscall(SYS_adjtimex, &ktx); |
| 119 |
else |
| 120 |
#endif |
| 121 |
r = __syscall(SYS_clock_adjtime, clock_id, &ktx); |
| 122 |
if (r>=0) { |
| 123 |
utx->modes = ktx.modes; |
| 124 |
utx->offset = ktx.offset; |
| 125 |
utx->freq = ktx.freq; |
| 126 |
utx->maxerror = ktx.maxerror; |
| 127 |
utx->esterror = ktx.esterror; |
| 128 |
utx->status = ktx.status; |
| 129 |
utx->constant = ktx.constant; |
| 130 |
utx->precision = ktx.precision; |
| 131 |
utx->tolerance = ktx.tolerance; |
| 132 |
utx->time.tv_sec = ktx.time_sec; |
| 133 |
utx->time.tv_usec = ktx.time_usec; |
| 134 |
utx->tick = ktx.tick; |
| 135 |
utx->ppsfreq = ktx.ppsfreq; |
| 136 |
utx->jitter = ktx.jitter; |
| 137 |
utx->shift = ktx.shift; |
| 138 |
utx->stabil = ktx.stabil; |
| 139 |
utx->jitcnt = ktx.jitcnt; |
| 140 |
utx->calcnt = ktx.calcnt; |
| 141 |
utx->errcnt = ktx.errcnt; |
| 142 |
utx->stbcnt = ktx.stbcnt; |
| 143 |
utx->tai = ktx.tai; |
| 144 |
} |
| 145 |
return __syscall_ret(r); |
| 146 |
} |
| 147 |
#ifdef SYS_adjtimex |
| 148 |
if (clock_id==CLOCK_REALTIME) return syscall(SYS_adjtimex, utx); |
| 149 |
#endif |
| 150 |
return syscall(SYS_clock_adjtime, clock_id, utx); |
| 151 |
} |