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