Commit | Line | Data |
---|---|---|
02bcaa8c | 1 | /* |
f5cc024a | 2 | * Clock functions |
02bcaa8c | 3 | */ |
f5cc024a | 4 | |
02bcaa8c | 5 | #include <unistd.h> |
c223da83 | 6 | #include <math.h> |
02bcaa8c | 7 | #include <sys/time.h> |
03e20d68 | 8 | #include <time.h> |
02bcaa8c JA |
9 | |
10 | #include "fio.h" | |
be4ecfdf | 11 | #include "smalloc.h" |
02bcaa8c JA |
12 | |
13 | #include "hash.h" | |
7d11f871 | 14 | #include "os/os.h" |
02bcaa8c | 15 | |
dac499a0 AV |
16 | #if defined(ARCH_HAVE_CPU_CLOCK) |
17 | #ifndef ARCH_CPU_CLOCK_CYCLES_PER_USEC | |
2aebc5a1 | 18 | static unsigned long cycles_per_msec; |
6d02b37b VF |
19 | static unsigned long long cycles_start; |
20 | static unsigned long long clock_mult; | |
21 | static unsigned long long max_cycles_mask; | |
22 | static unsigned long long nsecs_for_max_cycles; | |
23 | static unsigned int clock_shift; | |
24 | static unsigned int max_cycles_shift; | |
25 | #define MAX_CLOCK_SEC 60*60 | |
96170421 CE |
26 | #endif |
27 | #ifdef ARCH_CPU_CLOCK_WRAPS | |
6d02b37b | 28 | static unsigned int cycles_wrap; |
09a32402 | 29 | #endif |
dac499a0 | 30 | #endif |
24575392 | 31 | bool tsc_reliable = false; |
5d879392 JA |
32 | |
33 | struct tv_valid { | |
02dcf81c | 34 | int warned; |
5d879392 | 35 | }; |
03be65c9 | 36 | #ifdef ARCH_HAVE_CPU_CLOCK |
67bf9823 | 37 | #ifdef CONFIG_TLS_THREAD |
b4ea84da | 38 | static __thread struct tv_valid static_tv_valid; |
67bf9823 | 39 | #else |
5d879392 | 40 | static pthread_key_t tv_tls_key; |
67bf9823 | 41 | #endif |
03be65c9 | 42 | #endif |
02bcaa8c | 43 | |
16de1bf9 | 44 | enum fio_cs fio_clock_source = FIO_PREFERRED_CLOCK_SOURCE; |
fa80feae | 45 | int fio_clock_source_set = 0; |
10aa136b | 46 | static enum fio_cs fio_clock_source_inited = CS_INVAL; |
c223da83 | 47 | |
02bcaa8c JA |
48 | #ifdef FIO_DEBUG_TIME |
49 | ||
50 | #define HASH_BITS 8 | |
51 | #define HASH_SIZE (1 << HASH_BITS) | |
52 | ||
01743ee1 | 53 | static struct flist_head hash[HASH_SIZE]; |
02bcaa8c JA |
54 | static int gtod_inited; |
55 | ||
56 | struct gtod_log { | |
01743ee1 | 57 | struct flist_head list; |
02bcaa8c JA |
58 | void *caller; |
59 | unsigned long calls; | |
60 | }; | |
61 | ||
62 | static struct gtod_log *find_hash(void *caller) | |
63 | { | |
64 | unsigned long h = hash_ptr(caller, HASH_BITS); | |
01743ee1 | 65 | struct flist_head *entry; |
02bcaa8c | 66 | |
01743ee1 JA |
67 | flist_for_each(entry, &hash[h]) { |
68 | struct gtod_log *log = flist_entry(entry, struct gtod_log, | |
69 | list); | |
02bcaa8c JA |
70 | |
71 | if (log->caller == caller) | |
72 | return log; | |
73 | } | |
74 | ||
75 | return NULL; | |
76 | } | |
77 | ||
d5e16441 | 78 | static void inc_caller(void *caller) |
02bcaa8c JA |
79 | { |
80 | struct gtod_log *log = find_hash(caller); | |
81 | ||
82 | if (!log) { | |
83 | unsigned long h; | |
84 | ||
85 | log = malloc(sizeof(*log)); | |
01743ee1 | 86 | INIT_FLIST_HEAD(&log->list); |
02bcaa8c JA |
87 | log->caller = caller; |
88 | log->calls = 0; | |
89 | ||
90 | h = hash_ptr(caller, HASH_BITS); | |
01743ee1 | 91 | flist_add_tail(&log->list, &hash[h]); |
02bcaa8c JA |
92 | } |
93 | ||
d5e16441 | 94 | log->calls++; |
02bcaa8c JA |
95 | } |
96 | ||
97 | static void gtod_log_caller(void *caller) | |
98 | { | |
d5e16441 JA |
99 | if (gtod_inited) |
100 | inc_caller(caller); | |
02bcaa8c JA |
101 | } |
102 | ||
103 | static void fio_exit fio_dump_gtod(void) | |
104 | { | |
105 | unsigned long total_calls = 0; | |
106 | int i; | |
107 | ||
108 | for (i = 0; i < HASH_SIZE; i++) { | |
01743ee1 | 109 | struct flist_head *entry; |
02bcaa8c JA |
110 | struct gtod_log *log; |
111 | ||
01743ee1 JA |
112 | flist_for_each(entry, &hash[i]) { |
113 | log = flist_entry(entry, struct gtod_log, list); | |
02bcaa8c | 114 | |
5ec10eaa JA |
115 | printf("function %p, calls %lu\n", log->caller, |
116 | log->calls); | |
02bcaa8c JA |
117 | total_calls += log->calls; |
118 | } | |
119 | } | |
120 | ||
121 | printf("Total %lu gettimeofday\n", total_calls); | |
122 | } | |
123 | ||
124 | static void fio_init gtod_init(void) | |
125 | { | |
126 | int i; | |
127 | ||
128 | for (i = 0; i < HASH_SIZE; i++) | |
01743ee1 | 129 | INIT_FLIST_HEAD(&hash[i]); |
02bcaa8c JA |
130 | |
131 | gtod_inited = 1; | |
132 | } | |
133 | ||
134 | #endif /* FIO_DEBUG_TIME */ | |
135 | ||
67bf9823 | 136 | #ifdef CONFIG_CLOCK_GETTIME |
9ff1c070 JA |
137 | static int fill_clock_gettime(struct timespec *ts) |
138 | { | |
c544f604 SN |
139 | #if defined(CONFIG_CLOCK_MONOTONIC_RAW) |
140 | return clock_gettime(CLOCK_MONOTONIC_RAW, ts); | |
141 | #elif defined(CONFIG_CLOCK_MONOTONIC) | |
9ff1c070 JA |
142 | return clock_gettime(CLOCK_MONOTONIC, ts); |
143 | #else | |
144 | return clock_gettime(CLOCK_REALTIME, ts); | |
145 | #endif | |
146 | } | |
1e97cce9 | 147 | #endif |
67bf9823 | 148 | |
8b6a404c | 149 | static void __fio_gettime(struct timespec *tp) |
02bcaa8c | 150 | { |
c223da83 | 151 | switch (fio_clock_source) { |
67bf9823 | 152 | #ifdef CONFIG_GETTIMEOFDAY |
8b6a404c VF |
153 | case CS_GTOD: { |
154 | struct timeval tv; | |
155 | gettimeofday(&tv, NULL); | |
156 | ||
157 | tp->tv_sec = tv.tv_sec; | |
158 | tp->tv_nsec = tv.tv_usec * 1000; | |
c223da83 | 159 | break; |
8b6a404c | 160 | } |
67bf9823 JA |
161 | #endif |
162 | #ifdef CONFIG_CLOCK_GETTIME | |
c223da83 | 163 | case CS_CGETTIME: { |
8b6a404c | 164 | if (fill_clock_gettime(tp) < 0) { |
c223da83 JA |
165 | log_err("fio: clock_gettime fails\n"); |
166 | assert(0); | |
02bcaa8c | 167 | } |
c223da83 JA |
168 | break; |
169 | } | |
67bf9823 | 170 | #endif |
c223da83 JA |
171 | #ifdef ARCH_HAVE_CPU_CLOCK |
172 | case CS_CPUCLOCK: { | |
6d02b37b | 173 | uint64_t nsecs, t, multiples; |
03be65c9 JA |
174 | struct tv_valid *tv; |
175 | ||
176 | #ifdef CONFIG_TLS_THREAD | |
177 | tv = &static_tv_valid; | |
178 | #else | |
179 | tv = pthread_getspecific(tv_tls_key); | |
180 | #endif | |
c223da83 JA |
181 | |
182 | t = get_cpu_clock(); | |
96170421 | 183 | #ifdef ARCH_CPU_CLOCK_WRAPS |
73df3e07 JA |
184 | if (t < cycles_start && !cycles_wrap) |
185 | cycles_wrap = 1; | |
03be65c9 JA |
186 | else if (cycles_wrap && t >= cycles_start && !tv->warned) { |
187 | log_err("fio: double CPU clock wrap\n"); | |
188 | tv->warned = 1; | |
02dcf81c | 189 | } |
96170421 | 190 | #endif |
919e789d | 191 | #ifdef ARCH_CPU_CLOCK_CYCLES_PER_USEC |
6d02b37b | 192 | nsecs = t / ARCH_CPU_CLOCK_CYCLES_PER_USEC * 1000; |
919e789d | 193 | #else |
6d02b37b VF |
194 | t -= cycles_start; |
195 | multiples = t >> max_cycles_shift; | |
196 | nsecs = multiples * nsecs_for_max_cycles; | |
197 | nsecs += ((t & max_cycles_mask) * clock_mult) >> clock_shift; | |
919e789d | 198 | #endif |
8b6a404c VF |
199 | tp->tv_sec = nsecs / 1000000000ULL; |
200 | tp->tv_nsec = nsecs % 1000000000ULL; | |
c223da83 JA |
201 | break; |
202 | } | |
203 | #endif | |
204 | default: | |
205 | log_err("fio: invalid clock source %d\n", fio_clock_source); | |
206 | break; | |
02bcaa8c | 207 | } |
67bf9823 JA |
208 | } |
209 | ||
210 | #ifdef FIO_DEBUG_TIME | |
8b6a404c | 211 | void fio_gettime(struct timespec *tp, void *caller) |
67bf9823 | 212 | #else |
8b6a404c | 213 | void fio_gettime(struct timespec *tp, void fio_unused *caller) |
67bf9823 JA |
214 | #endif |
215 | { | |
67bf9823 JA |
216 | #ifdef FIO_DEBUG_TIME |
217 | if (!caller) | |
218 | caller = __builtin_return_address(0); | |
219 | ||
220 | gtod_log_caller(caller); | |
221 | #endif | |
27325ed5 | 222 | if (fio_unlikely(fio_gettime_offload(tp))) |
67bf9823 | 223 | return; |
67bf9823 | 224 | |
9eb271b9 | 225 | __fio_gettime(tp); |
02bcaa8c | 226 | } |
be4ecfdf | 227 | |
919e789d | 228 | #if defined(ARCH_HAVE_CPU_CLOCK) && !defined(ARCH_CPU_CLOCK_CYCLES_PER_USEC) |
2aebc5a1 | 229 | static unsigned long get_cycles_per_msec(void) |
c223da83 | 230 | { |
8b6a404c | 231 | struct timespec s, e; |
ba458c2f | 232 | uint64_t c_s, c_e; |
67bf9823 | 233 | enum fio_cs old_cs = fio_clock_source; |
99afcdb5 | 234 | uint64_t elapsed; |
c223da83 | 235 | |
67bf9823 JA |
236 | #ifdef CONFIG_CLOCK_GETTIME |
237 | fio_clock_source = CS_CGETTIME; | |
238 | #else | |
239 | fio_clock_source = CS_GTOD; | |
240 | #endif | |
241 | __fio_gettime(&s); | |
9ff1c070 | 242 | |
c223da83 JA |
243 | c_s = get_cpu_clock(); |
244 | do { | |
67bf9823 | 245 | __fio_gettime(&e); |
9ff1c070 | 246 | |
c223da83 | 247 | elapsed = utime_since(&s, &e); |
486332e5 | 248 | if (elapsed >= 1280) { |
c223da83 JA |
249 | c_e = get_cpu_clock(); |
250 | break; | |
251 | } | |
252 | } while (1); | |
253 | ||
67bf9823 | 254 | fio_clock_source = old_cs; |
2aebc5a1 | 255 | return (c_e - c_s) * 1000 / elapsed; |
c223da83 JA |
256 | } |
257 | ||
fa80feae JA |
258 | #define NR_TIME_ITERS 50 |
259 | ||
e259879e | 260 | static int calibrate_cpu_clock(void) |
c223da83 JA |
261 | { |
262 | double delta, mean, S; | |
e51a6629 | 263 | uint64_t minc, maxc, avg, cycles[NR_TIME_ITERS]; |
6d02b37b VF |
264 | int i, samples, sft = 0; |
265 | unsigned long long tmp, max_ticks, max_mult; | |
c223da83 | 266 | |
2aebc5a1 | 267 | cycles[0] = get_cycles_per_msec(); |
c223da83 | 268 | S = delta = mean = 0.0; |
fa80feae | 269 | for (i = 0; i < NR_TIME_ITERS; i++) { |
2aebc5a1 | 270 | cycles[i] = get_cycles_per_msec(); |
c223da83 JA |
271 | delta = cycles[i] - mean; |
272 | if (delta) { | |
273 | mean += delta / (i + 1.0); | |
274 | S += delta * (cycles[i] - mean); | |
275 | } | |
276 | } | |
277 | ||
e259879e JA |
278 | /* |
279 | * The most common platform clock breakage is returning zero | |
280 | * indefinitely. Check for that and return failure. | |
281 | */ | |
282 | if (!cycles[0] && !cycles[NR_TIME_ITERS - 1]) | |
283 | return 1; | |
284 | ||
fa80feae | 285 | S = sqrt(S / (NR_TIME_ITERS - 1.0)); |
c223da83 | 286 | |
e51a6629 JA |
287 | minc = -1ULL; |
288 | maxc = samples = avg = 0; | |
fa80feae | 289 | for (i = 0; i < NR_TIME_ITERS; i++) { |
c223da83 JA |
290 | double this = cycles[i]; |
291 | ||
e51a6629 JA |
292 | minc = min(cycles[i], minc); |
293 | maxc = max(cycles[i], maxc); | |
294 | ||
03e20d68 | 295 | if ((fmax(this, mean) - fmin(this, mean)) > S) |
c223da83 JA |
296 | continue; |
297 | samples++; | |
298 | avg += this; | |
299 | } | |
300 | ||
fa80feae | 301 | S /= (double) NR_TIME_ITERS; |
c223da83 | 302 | |
fa80feae | 303 | for (i = 0; i < NR_TIME_ITERS; i++) |
13aa415a | 304 | dprint(FD_TIME, "cycles[%d]=%llu\n", i, (unsigned long long) cycles[i]); |
c223da83 | 305 | |
d7abad3d | 306 | avg /= samples; |
2aebc5a1 | 307 | cycles_per_msec = avg; |
4b91ee8f | 308 | dprint(FD_TIME, "avg: %llu\n", (unsigned long long) avg); |
e51a6629 JA |
309 | dprint(FD_TIME, "min=%llu, max=%llu, mean=%f, S=%f\n", |
310 | (unsigned long long) minc, | |
311 | (unsigned long long) maxc, mean, S); | |
c223da83 | 312 | |
2aebc5a1 | 313 | max_ticks = MAX_CLOCK_SEC * cycles_per_msec * 1000ULL; |
74558486 JA |
314 | max_mult = ULLONG_MAX / max_ticks; |
315 | dprint(FD_TIME, "\n\nmax_ticks=%llu, __builtin_clzll=%d, " | |
316 | "max_mult=%llu\n", max_ticks, | |
317 | __builtin_clzll(max_ticks), max_mult); | |
6d02b37b VF |
318 | |
319 | /* | |
320 | * Find the largest shift count that will produce | |
321 | * a multiplier that does not exceed max_mult | |
322 | */ | |
2aebc5a1 | 323 | tmp = max_mult * cycles_per_msec / 1000000; |
6d02b37b VF |
324 | while (tmp > 1) { |
325 | tmp >>= 1; | |
326 | sft++; | |
327 | dprint(FD_TIME, "tmp=%llu, sft=%u\n", tmp, sft); | |
328 | } | |
329 | ||
74558486 JA |
330 | clock_shift = sft; |
331 | clock_mult = (1ULL << sft) * 1000000 / cycles_per_msec; | |
332 | dprint(FD_TIME, "clock_shift=%u, clock_mult=%llu\n", clock_shift, | |
333 | clock_mult); | |
6d02b37b | 334 | |
74558486 JA |
335 | /* |
336 | * Find the greatest power of 2 clock ticks that is less than the | |
337 | * ticks in MAX_CLOCK_SEC_2STAGE | |
338 | */ | |
6d02b37b | 339 | max_cycles_shift = max_cycles_mask = 0; |
2aebc5a1 | 340 | tmp = MAX_CLOCK_SEC * 1000ULL * cycles_per_msec; |
74558486 JA |
341 | dprint(FD_TIME, "tmp=%llu, max_cycles_shift=%u\n", tmp, |
342 | max_cycles_shift); | |
6d02b37b VF |
343 | while (tmp > 1) { |
344 | tmp >>= 1; | |
345 | max_cycles_shift++; | |
346 | dprint(FD_TIME, "tmp=%llu, max_cycles_shift=%u\n", tmp, max_cycles_shift); | |
347 | } | |
74558486 JA |
348 | /* |
349 | * if use use (1ULL << max_cycles_shift) * 1000 / cycles_per_msec | |
350 | * here we will have a discontinuity every | |
351 | * (1ULL << max_cycles_shift) cycles | |
352 | */ | |
353 | nsecs_for_max_cycles = ((1ULL << max_cycles_shift) * clock_mult) | |
354 | >> clock_shift; | |
6d02b37b | 355 | |
74558486 | 356 | /* Use a bitmask to calculate ticks % (1ULL << max_cycles_shift) */ |
6d02b37b VF |
357 | for (tmp = 0; tmp < max_cycles_shift; tmp++) |
358 | max_cycles_mask |= 1ULL << tmp; | |
359 | ||
74558486 JA |
360 | dprint(FD_TIME, "max_cycles_shift=%u, 2^max_cycles_shift=%llu, " |
361 | "nsecs_for_max_cycles=%llu, " | |
362 | "max_cycles_mask=%016llx\n", | |
363 | max_cycles_shift, (1ULL << max_cycles_shift), | |
364 | nsecs_for_max_cycles, max_cycles_mask); | |
6d02b37b | 365 | |
73df3e07 JA |
366 | cycles_start = get_cpu_clock(); |
367 | dprint(FD_TIME, "cycles_start=%llu\n", cycles_start); | |
e259879e | 368 | return 0; |
09a32402 JA |
369 | } |
370 | #else | |
e259879e | 371 | static int calibrate_cpu_clock(void) |
09a32402 | 372 | { |
919e789d CE |
373 | #ifdef ARCH_CPU_CLOCK_CYCLES_PER_USEC |
374 | return 0; | |
375 | #else | |
e259879e | 376 | return 1; |
09a32402 | 377 | #endif |
919e789d CE |
378 | } |
379 | #endif // ARCH_HAVE_CPU_CLOCK | |
09a32402 | 380 | |
67bf9823 | 381 | #ifndef CONFIG_TLS_THREAD |
5d879392 JA |
382 | void fio_local_clock_init(int is_thread) |
383 | { | |
384 | struct tv_valid *t; | |
385 | ||
572cfb3f | 386 | t = calloc(1, sizeof(*t)); |
9eb271b9 | 387 | if (pthread_setspecific(tv_tls_key, t)) { |
5d879392 | 388 | log_err("fio: can't set TLS key\n"); |
9eb271b9 JA |
389 | assert(0); |
390 | } | |
5d879392 JA |
391 | } |
392 | ||
393 | static void kill_tv_tls_key(void *data) | |
394 | { | |
395 | free(data); | |
396 | } | |
67bf9823 JA |
397 | #else |
398 | void fio_local_clock_init(int is_thread) | |
399 | { | |
400 | } | |
401 | #endif | |
5d879392 | 402 | |
09a32402 JA |
403 | void fio_clock_init(void) |
404 | { | |
01423eae JA |
405 | if (fio_clock_source == fio_clock_source_inited) |
406 | return; | |
407 | ||
67bf9823 | 408 | #ifndef CONFIG_TLS_THREAD |
5d879392 JA |
409 | if (pthread_key_create(&tv_tls_key, kill_tv_tls_key)) |
410 | log_err("fio: can't create TLS key\n"); | |
67bf9823 | 411 | #endif |
5d879392 | 412 | |
01423eae | 413 | fio_clock_source_inited = fio_clock_source; |
e259879e JA |
414 | |
415 | if (calibrate_cpu_clock()) | |
24575392 | 416 | tsc_reliable = false; |
fa80feae JA |
417 | |
418 | /* | |
419 | * If the arch sets tsc_reliable != 0, then it must be good enough | |
420 | * to use as THE clock source. For x86 CPUs, this means the TSC | |
421 | * runs at a constant rate and is synced across CPU cores. | |
422 | */ | |
423 | if (tsc_reliable) { | |
aad918e4 | 424 | if (!fio_clock_source_set && !fio_monotonic_clocktest(0)) |
fa80feae JA |
425 | fio_clock_source = CS_CPUCLOCK; |
426 | } else if (fio_clock_source == CS_CPUCLOCK) | |
427 | log_info("fio: clocksource=cpu may not be reliable\n"); | |
c223da83 JA |
428 | } |
429 | ||
d6bb626e VF |
430 | uint64_t ntime_since(const struct timespec *s, const struct timespec *e) |
431 | { | |
432 | int64_t sec, nsec; | |
433 | ||
434 | sec = e->tv_sec - s->tv_sec; | |
435 | nsec = e->tv_nsec - s->tv_nsec; | |
436 | if (sec > 0 && nsec < 0) { | |
6d02b37b VF |
437 | sec--; |
438 | nsec += 1000000000LL; | |
d6bb626e VF |
439 | } |
440 | ||
441 | /* | |
6d02b37b VF |
442 | * time warp bug on some kernels? |
443 | */ | |
d6bb626e | 444 | if (sec < 0 || (sec == 0 && nsec < 0)) |
6d02b37b | 445 | return 0; |
d6bb626e VF |
446 | |
447 | return nsec + (sec * 1000000000LL); | |
448 | } | |
449 | ||
8b6a404c | 450 | uint64_t utime_since(const struct timespec *s, const struct timespec *e) |
be4ecfdf | 451 | { |
90eff1c9 | 452 | int64_t sec, usec; |
39ab7da2 JA |
453 | |
454 | sec = e->tv_sec - s->tv_sec; | |
8b6a404c | 455 | usec = (e->tv_nsec - s->tv_nsec) / 1000; |
39ab7da2 JA |
456 | if (sec > 0 && usec < 0) { |
457 | sec--; | |
458 | usec += 1000000; | |
459 | } | |
460 | ||
461 | /* | |
462 | * time warp bug on some kernels? | |
463 | */ | |
464 | if (sec < 0 || (sec == 0 && usec < 0)) | |
465 | return 0; | |
466 | ||
20ac4e77 | 467 | return usec + (sec * 1000000); |
be4ecfdf JA |
468 | } |
469 | ||
8b6a404c | 470 | uint64_t utime_since_now(const struct timespec *s) |
be4ecfdf | 471 | { |
8b6a404c | 472 | struct timespec t; |
f52e9198 VF |
473 | #ifdef FIO_DEBUG_TIME |
474 | void *p = __builtin_return_address(0); | |
39ab7da2 | 475 | |
f52e9198 VF |
476 | fio_gettime(&t, p); |
477 | #else | |
39ab7da2 | 478 | fio_gettime(&t, NULL); |
f52e9198 VF |
479 | #endif |
480 | ||
39ab7da2 | 481 | return utime_since(s, &t); |
be4ecfdf | 482 | } |
783a3eb1 | 483 | |
8b6a404c | 484 | uint64_t mtime_since_tv(const struct timeval *s, const struct timeval *e) |
783a3eb1 | 485 | { |
8b6a404c | 486 | int64_t sec, usec; |
783a3eb1 | 487 | |
39ab7da2 | 488 | sec = e->tv_sec - s->tv_sec; |
8b6a404c | 489 | usec = (e->tv_usec - s->tv_usec); |
39ab7da2 JA |
490 | if (sec > 0 && usec < 0) { |
491 | sec--; | |
492 | usec += 1000000; | |
783a3eb1 JA |
493 | } |
494 | ||
39ab7da2 JA |
495 | if (sec < 0 || (sec == 0 && usec < 0)) |
496 | return 0; | |
497 | ||
be6bb2b7 Y |
498 | sec *= 1000; |
499 | usec /= 1000; | |
20ac4e77 | 500 | return sec + usec; |
783a3eb1 JA |
501 | } |
502 | ||
8b6a404c | 503 | uint64_t mtime_since_now(const struct timespec *s) |
783a3eb1 | 504 | { |
8b6a404c | 505 | struct timespec t; |
f52e9198 | 506 | #ifdef FIO_DEBUG_TIME |
39ab7da2 | 507 | void *p = __builtin_return_address(0); |
783a3eb1 | 508 | |
39ab7da2 | 509 | fio_gettime(&t, p); |
f52e9198 VF |
510 | #else |
511 | fio_gettime(&t, NULL); | |
512 | #endif | |
513 | ||
39ab7da2 JA |
514 | return mtime_since(s, &t); |
515 | } | |
783a3eb1 | 516 | |
8b6a404c VF |
517 | uint64_t mtime_since(const struct timespec *s, const struct timespec *e) |
518 | { | |
519 | int64_t sec, usec; | |
520 | ||
521 | sec = e->tv_sec - s->tv_sec; | |
522 | usec = (e->tv_nsec - s->tv_nsec) / 1000; | |
523 | if (sec > 0 && usec < 0) { | |
524 | sec--; | |
525 | usec += 1000000; | |
526 | } | |
527 | ||
528 | if (sec < 0 || (sec == 0 && usec < 0)) | |
529 | return 0; | |
530 | ||
531 | sec *= 1000; | |
532 | usec /= 1000; | |
533 | return sec + usec; | |
534 | } | |
535 | ||
536 | uint64_t time_since_now(const struct timespec *s) | |
39ab7da2 JA |
537 | { |
538 | return mtime_since_now(s) / 1000; | |
783a3eb1 | 539 | } |
7d11f871 | 540 | |
67bf9823 JA |
541 | #if defined(FIO_HAVE_CPU_AFFINITY) && defined(ARCH_HAVE_CPU_CLOCK) && \ |
542 | defined(CONFIG_SFAA) | |
7d11f871 | 543 | |
aad918e4 JA |
544 | #define CLOCK_ENTRIES_DEBUG 100000 |
545 | #define CLOCK_ENTRIES_TEST 10000 | |
7d11f871 JA |
546 | |
547 | struct clock_entry { | |
58002f9a JA |
548 | uint32_t seq; |
549 | uint32_t cpu; | |
ba458c2f | 550 | uint64_t tsc; |
7d11f871 JA |
551 | }; |
552 | ||
553 | struct clock_thread { | |
554 | pthread_t thread; | |
555 | int cpu; | |
aad918e4 | 556 | int debug; |
7d11f871 JA |
557 | pthread_mutex_t lock; |
558 | pthread_mutex_t started; | |
aad918e4 | 559 | unsigned long nr_entries; |
58002f9a | 560 | uint32_t *seq; |
7d11f871 JA |
561 | struct clock_entry *entries; |
562 | }; | |
563 | ||
58002f9a | 564 | static inline uint32_t atomic32_inc_return(uint32_t *seq) |
7d11f871 JA |
565 | { |
566 | return 1 + __sync_fetch_and_add(seq, 1); | |
567 | } | |
568 | ||
569 | static void *clock_thread_fn(void *data) | |
570 | { | |
571 | struct clock_thread *t = data; | |
572 | struct clock_entry *c; | |
573 | os_cpu_mask_t cpu_mask; | |
58002f9a | 574 | uint32_t last_seq; |
5896d827 | 575 | unsigned long long first; |
7d11f871 JA |
576 | int i; |
577 | ||
c763aea6 | 578 | if (fio_cpuset_init(&cpu_mask)) { |
37e20021 | 579 | int __err = errno; |
c763aea6 JA |
580 | |
581 | log_err("clock cpuset init failed: %s\n", strerror(__err)); | |
582 | goto err_out; | |
583 | } | |
584 | ||
7d11f871 JA |
585 | fio_cpu_set(&cpu_mask, t->cpu); |
586 | ||
587 | if (fio_setaffinity(gettid(), cpu_mask) == -1) { | |
e66d7f90 JA |
588 | int __err = errno; |
589 | ||
590 | log_err("clock setaffinity failed: %s\n", strerror(__err)); | |
c763aea6 | 591 | goto err; |
7d11f871 JA |
592 | } |
593 | ||
7d11f871 | 594 | pthread_mutex_lock(&t->lock); |
b9b3498e | 595 | pthread_mutex_unlock(&t->started); |
7d11f871 | 596 | |
5896d827 | 597 | first = get_cpu_clock(); |
58002f9a | 598 | last_seq = 0; |
7d11f871 | 599 | c = &t->entries[0]; |
aad918e4 | 600 | for (i = 0; i < t->nr_entries; i++, c++) { |
58002f9a JA |
601 | uint32_t seq; |
602 | uint64_t tsc; | |
7d11f871 JA |
603 | |
604 | c->cpu = t->cpu; | |
605 | do { | |
58002f9a JA |
606 | seq = atomic32_inc_return(t->seq); |
607 | if (seq < last_seq) | |
608 | break; | |
7d11f871 JA |
609 | tsc = get_cpu_clock(); |
610 | } while (seq != *t->seq); | |
611 | ||
612 | c->seq = seq; | |
613 | c->tsc = tsc; | |
614 | } | |
615 | ||
aad918e4 JA |
616 | if (t->debug) { |
617 | unsigned long long clocks; | |
618 | ||
619 | clocks = t->entries[i - 1].tsc - t->entries[0].tsc; | |
5896d827 JA |
620 | log_info("cs: cpu%3d: %llu clocks seen, first %llu\n", t->cpu, |
621 | clocks, first); | |
aad918e4 | 622 | } |
58002f9a | 623 | |
e259879e JA |
624 | /* |
625 | * The most common platform clock breakage is returning zero | |
626 | * indefinitely. Check for that and return failure. | |
627 | */ | |
58002f9a | 628 | if (!t->entries[i - 1].tsc && !t->entries[0].tsc) |
c763aea6 | 629 | goto err; |
e259879e | 630 | |
d47d7cb3 | 631 | fio_cpuset_exit(&cpu_mask); |
7d11f871 | 632 | return NULL; |
c763aea6 JA |
633 | err: |
634 | fio_cpuset_exit(&cpu_mask); | |
635 | err_out: | |
636 | return (void *) 1; | |
7d11f871 JA |
637 | } |
638 | ||
639 | static int clock_cmp(const void *p1, const void *p2) | |
640 | { | |
641 | const struct clock_entry *c1 = p1; | |
642 | const struct clock_entry *c2 = p2; | |
643 | ||
b9b3498e JA |
644 | if (c1->seq == c2->seq) |
645 | log_err("cs: bug in atomic sequence!\n"); | |
646 | ||
7d11f871 JA |
647 | return c1->seq - c2->seq; |
648 | } | |
649 | ||
aad918e4 | 650 | int fio_monotonic_clocktest(int debug) |
7d11f871 | 651 | { |
8a1db9a1 | 652 | struct clock_thread *cthreads; |
7d11f871 JA |
653 | unsigned int nr_cpus = cpus_online(); |
654 | struct clock_entry *entries; | |
aad918e4 | 655 | unsigned long nr_entries, tentries, failed = 0; |
80da8a8f | 656 | struct clock_entry *prev, *this; |
58002f9a | 657 | uint32_t seq = 0; |
caa3eb1c | 658 | unsigned int i; |
7d11f871 | 659 | |
aad918e4 JA |
660 | if (debug) { |
661 | log_info("cs: reliable_tsc: %s\n", tsc_reliable ? "yes" : "no"); | |
d5e3f5d8 | 662 | |
b5b571a3 | 663 | #ifdef FIO_INC_DEBUG |
aad918e4 | 664 | fio_debug |= 1U << FD_TIME; |
b5b571a3 | 665 | #endif |
aad918e4 JA |
666 | nr_entries = CLOCK_ENTRIES_DEBUG; |
667 | } else | |
668 | nr_entries = CLOCK_ENTRIES_TEST; | |
669 | ||
4f1d43c2 | 670 | calibrate_cpu_clock(); |
aad918e4 JA |
671 | |
672 | if (debug) { | |
b5b571a3 | 673 | #ifdef FIO_INC_DEBUG |
aad918e4 | 674 | fio_debug &= ~(1U << FD_TIME); |
b5b571a3 | 675 | #endif |
aad918e4 | 676 | } |
4f1d43c2 | 677 | |
8a1db9a1 | 678 | cthreads = malloc(nr_cpus * sizeof(struct clock_thread)); |
aad918e4 | 679 | tentries = nr_entries * nr_cpus; |
7d11f871 JA |
680 | entries = malloc(tentries * sizeof(struct clock_entry)); |
681 | ||
aad918e4 JA |
682 | if (debug) |
683 | log_info("cs: Testing %u CPUs\n", nr_cpus); | |
7d11f871 JA |
684 | |
685 | for (i = 0; i < nr_cpus; i++) { | |
8a1db9a1 | 686 | struct clock_thread *t = &cthreads[i]; |
7d11f871 JA |
687 | |
688 | t->cpu = i; | |
aad918e4 | 689 | t->debug = debug; |
7d11f871 | 690 | t->seq = &seq; |
aad918e4 JA |
691 | t->nr_entries = nr_entries; |
692 | t->entries = &entries[i * nr_entries]; | |
7d11f871 JA |
693 | pthread_mutex_init(&t->lock, NULL); |
694 | pthread_mutex_init(&t->started, NULL); | |
695 | pthread_mutex_lock(&t->lock); | |
6b0110cd JA |
696 | if (pthread_create(&t->thread, NULL, clock_thread_fn, t)) { |
697 | failed++; | |
698 | nr_cpus = i; | |
699 | break; | |
700 | } | |
7d11f871 JA |
701 | } |
702 | ||
703 | for (i = 0; i < nr_cpus; i++) { | |
8a1db9a1 | 704 | struct clock_thread *t = &cthreads[i]; |
7d11f871 JA |
705 | |
706 | pthread_mutex_lock(&t->started); | |
707 | } | |
708 | ||
709 | for (i = 0; i < nr_cpus; i++) { | |
8a1db9a1 | 710 | struct clock_thread *t = &cthreads[i]; |
7d11f871 JA |
711 | |
712 | pthread_mutex_unlock(&t->lock); | |
713 | } | |
714 | ||
814917be | 715 | for (i = 0; i < nr_cpus; i++) { |
8a1db9a1 | 716 | struct clock_thread *t = &cthreads[i]; |
7d11f871 JA |
717 | void *ret; |
718 | ||
719 | pthread_join(t->thread, &ret); | |
720 | if (ret) | |
721 | failed++; | |
722 | } | |
8a1db9a1 | 723 | free(cthreads); |
7d11f871 JA |
724 | |
725 | if (failed) { | |
aad918e4 JA |
726 | if (debug) |
727 | log_err("Clocksource test: %lu threads failed\n", failed); | |
7d11f871 JA |
728 | goto err; |
729 | } | |
730 | ||
731 | qsort(entries, tentries, sizeof(struct clock_entry), clock_cmp); | |
732 | ||
a4aa3dc0 JA |
733 | /* silence silly gcc */ |
734 | prev = NULL; | |
7d11f871 | 735 | for (failed = i = 0; i < tentries; i++) { |
80da8a8f | 736 | this = &entries[i]; |
7d11f871 JA |
737 | |
738 | if (!i) { | |
739 | prev = this; | |
740 | continue; | |
741 | } | |
742 | ||
743 | if (prev->tsc > this->tsc) { | |
744 | uint64_t diff = prev->tsc - this->tsc; | |
745 | ||
aad918e4 JA |
746 | if (!debug) { |
747 | failed++; | |
748 | break; | |
749 | } | |
750 | ||
4e0a8fa2 JA |
751 | log_info("cs: CPU clock mismatch (diff=%llu):\n", |
752 | (unsigned long long) diff); | |
753 | log_info("\t CPU%3u: TSC=%llu, SEQ=%u\n", prev->cpu, (unsigned long long) prev->tsc, prev->seq); | |
754 | log_info("\t CPU%3u: TSC=%llu, SEQ=%u\n", this->cpu, (unsigned long long) this->tsc, this->seq); | |
7d11f871 JA |
755 | failed++; |
756 | } | |
757 | ||
758 | prev = this; | |
759 | } | |
760 | ||
aad918e4 JA |
761 | if (debug) { |
762 | if (failed) | |
763 | log_info("cs: Failed: %lu\n", failed); | |
764 | else | |
765 | log_info("cs: Pass!\n"); | |
766 | } | |
7d11f871 JA |
767 | err: |
768 | free(entries); | |
769 | return !!failed; | |
770 | } | |
771 | ||
772 | #else /* defined(FIO_HAVE_CPU_AFFINITY) && defined(ARCH_HAVE_CPU_CLOCK) */ | |
773 | ||
aad918e4 | 774 | int fio_monotonic_clocktest(int debug) |
7d11f871 | 775 | { |
aad918e4 JA |
776 | if (debug) |
777 | log_info("cs: current platform does not support CPU clocks\n"); | |
778 | return 1; | |
7d11f871 JA |
779 | } |
780 | ||
781 | #endif |