162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (C) 2013  Davidlohr Bueso <davidlohr@hp.com>
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * futex-hash: Stress the hell out of the Linux kernel futex uaddr hashing.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * This program is particularly useful for measuring the kernel's futex hash
862306a36Sopenharmony_ci * table/function implementation. In order for it to make sense, use with as
962306a36Sopenharmony_ci * many threads and futexes as possible.
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci/* For the CLR_() macros */
1362306a36Sopenharmony_ci#include <string.h>
1462306a36Sopenharmony_ci#include <pthread.h>
1562306a36Sopenharmony_ci
1662306a36Sopenharmony_ci#include <errno.h>
1762306a36Sopenharmony_ci#include <signal.h>
1862306a36Sopenharmony_ci#include <stdlib.h>
1962306a36Sopenharmony_ci#include <linux/compiler.h>
2062306a36Sopenharmony_ci#include <linux/kernel.h>
2162306a36Sopenharmony_ci#include <linux/zalloc.h>
2262306a36Sopenharmony_ci#include <sys/time.h>
2362306a36Sopenharmony_ci#include <sys/mman.h>
2462306a36Sopenharmony_ci#include <perf/cpumap.h>
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#include "../util/mutex.h"
2762306a36Sopenharmony_ci#include "../util/stat.h"
2862306a36Sopenharmony_ci#include <subcmd/parse-options.h>
2962306a36Sopenharmony_ci#include "bench.h"
3062306a36Sopenharmony_ci#include "futex.h"
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci#include <err.h>
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_cistatic bool done = false;
3562306a36Sopenharmony_cistatic int futex_flag = 0;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistruct timeval bench__start, bench__end, bench__runtime;
3862306a36Sopenharmony_cistatic struct mutex thread_lock;
3962306a36Sopenharmony_cistatic unsigned int threads_starting;
4062306a36Sopenharmony_cistatic struct stats throughput_stats;
4162306a36Sopenharmony_cistatic struct cond thread_parent, thread_worker;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_cistruct worker {
4462306a36Sopenharmony_ci	int tid;
4562306a36Sopenharmony_ci	u_int32_t *futex;
4662306a36Sopenharmony_ci	pthread_t thread;
4762306a36Sopenharmony_ci	unsigned long ops;
4862306a36Sopenharmony_ci};
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic struct bench_futex_parameters params = {
5162306a36Sopenharmony_ci	.nfutexes = 1024,
5262306a36Sopenharmony_ci	.runtime  = 10,
5362306a36Sopenharmony_ci};
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_cistatic const struct option options[] = {
5662306a36Sopenharmony_ci	OPT_UINTEGER('t', "threads", &params.nthreads, "Specify amount of threads"),
5762306a36Sopenharmony_ci	OPT_UINTEGER('r', "runtime", &params.runtime, "Specify runtime (in seconds)"),
5862306a36Sopenharmony_ci	OPT_UINTEGER('f', "futexes", &params.nfutexes, "Specify amount of futexes per threads"),
5962306a36Sopenharmony_ci	OPT_BOOLEAN( 's', "silent",  &params.silent, "Silent mode: do not display data/details"),
6062306a36Sopenharmony_ci	OPT_BOOLEAN( 'S', "shared",  &params.fshared, "Use shared futexes instead of private ones"),
6162306a36Sopenharmony_ci	OPT_BOOLEAN( 'm', "mlockall", &params.mlockall, "Lock all current and future memory"),
6262306a36Sopenharmony_ci	OPT_END()
6362306a36Sopenharmony_ci};
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_cistatic const char * const bench_futex_hash_usage[] = {
6662306a36Sopenharmony_ci	"perf bench futex hash <options>",
6762306a36Sopenharmony_ci	NULL
6862306a36Sopenharmony_ci};
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_cistatic void *workerfn(void *arg)
7162306a36Sopenharmony_ci{
7262306a36Sopenharmony_ci	int ret;
7362306a36Sopenharmony_ci	struct worker *w = (struct worker *) arg;
7462306a36Sopenharmony_ci	unsigned int i;
7562306a36Sopenharmony_ci	unsigned long ops = w->ops; /* avoid cacheline bouncing */
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	mutex_lock(&thread_lock);
7862306a36Sopenharmony_ci	threads_starting--;
7962306a36Sopenharmony_ci	if (!threads_starting)
8062306a36Sopenharmony_ci		cond_signal(&thread_parent);
8162306a36Sopenharmony_ci	cond_wait(&thread_worker, &thread_lock);
8262306a36Sopenharmony_ci	mutex_unlock(&thread_lock);
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	do {
8562306a36Sopenharmony_ci		for (i = 0; i < params.nfutexes; i++, ops++) {
8662306a36Sopenharmony_ci			/*
8762306a36Sopenharmony_ci			 * We want the futex calls to fail in order to stress
8862306a36Sopenharmony_ci			 * the hashing of uaddr and not measure other steps,
8962306a36Sopenharmony_ci			 * such as internal waitqueue handling, thus enlarging
9062306a36Sopenharmony_ci			 * the critical region protected by hb->lock.
9162306a36Sopenharmony_ci			 */
9262306a36Sopenharmony_ci			ret = futex_wait(&w->futex[i], 1234, NULL, futex_flag);
9362306a36Sopenharmony_ci			if (!params.silent &&
9462306a36Sopenharmony_ci			    (!ret || errno != EAGAIN || errno != EWOULDBLOCK))
9562306a36Sopenharmony_ci				warn("Non-expected futex return call");
9662306a36Sopenharmony_ci		}
9762306a36Sopenharmony_ci	}  while (!done);
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_ci	w->ops = ops;
10062306a36Sopenharmony_ci	return NULL;
10162306a36Sopenharmony_ci}
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_cistatic void toggle_done(int sig __maybe_unused,
10462306a36Sopenharmony_ci			siginfo_t *info __maybe_unused,
10562306a36Sopenharmony_ci			void *uc __maybe_unused)
10662306a36Sopenharmony_ci{
10762306a36Sopenharmony_ci	/* inform all threads that we're done for the day */
10862306a36Sopenharmony_ci	done = true;
10962306a36Sopenharmony_ci	gettimeofday(&bench__end, NULL);
11062306a36Sopenharmony_ci	timersub(&bench__end, &bench__start, &bench__runtime);
11162306a36Sopenharmony_ci}
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_cistatic void print_summary(void)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	unsigned long avg = avg_stats(&throughput_stats);
11662306a36Sopenharmony_ci	double stddev = stddev_stats(&throughput_stats);
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	printf("%sAveraged %ld operations/sec (+- %.2f%%), total secs = %d\n",
11962306a36Sopenharmony_ci	       !params.silent ? "\n" : "", avg, rel_stddev_stats(stddev, avg),
12062306a36Sopenharmony_ci	       (int)bench__runtime.tv_sec);
12162306a36Sopenharmony_ci}
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_ciint bench_futex_hash(int argc, const char **argv)
12462306a36Sopenharmony_ci{
12562306a36Sopenharmony_ci	int ret = 0;
12662306a36Sopenharmony_ci	cpu_set_t *cpuset;
12762306a36Sopenharmony_ci	struct sigaction act;
12862306a36Sopenharmony_ci	unsigned int i;
12962306a36Sopenharmony_ci	pthread_attr_t thread_attr;
13062306a36Sopenharmony_ci	struct worker *worker = NULL;
13162306a36Sopenharmony_ci	struct perf_cpu_map *cpu;
13262306a36Sopenharmony_ci	int nrcpus;
13362306a36Sopenharmony_ci	size_t size;
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	argc = parse_options(argc, argv, options, bench_futex_hash_usage, 0);
13662306a36Sopenharmony_ci	if (argc) {
13762306a36Sopenharmony_ci		usage_with_options(bench_futex_hash_usage, options);
13862306a36Sopenharmony_ci		exit(EXIT_FAILURE);
13962306a36Sopenharmony_ci	}
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_ci	cpu = perf_cpu_map__new(NULL);
14262306a36Sopenharmony_ci	if (!cpu)
14362306a36Sopenharmony_ci		goto errmem;
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	memset(&act, 0, sizeof(act));
14662306a36Sopenharmony_ci	sigfillset(&act.sa_mask);
14762306a36Sopenharmony_ci	act.sa_sigaction = toggle_done;
14862306a36Sopenharmony_ci	sigaction(SIGINT, &act, NULL);
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	if (params.mlockall) {
15162306a36Sopenharmony_ci		if (mlockall(MCL_CURRENT | MCL_FUTURE))
15262306a36Sopenharmony_ci			err(EXIT_FAILURE, "mlockall");
15362306a36Sopenharmony_ci	}
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (!params.nthreads) /* default to the number of CPUs */
15662306a36Sopenharmony_ci		params.nthreads = perf_cpu_map__nr(cpu);
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	worker = calloc(params.nthreads, sizeof(*worker));
15962306a36Sopenharmony_ci	if (!worker)
16062306a36Sopenharmony_ci		goto errmem;
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	if (!params.fshared)
16362306a36Sopenharmony_ci		futex_flag = FUTEX_PRIVATE_FLAG;
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_ci	printf("Run summary [PID %d]: %d threads, each operating on %d [%s] futexes for %d secs.\n\n",
16662306a36Sopenharmony_ci	       getpid(), params.nthreads, params.nfutexes, params.fshared ? "shared":"private", params.runtime);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	init_stats(&throughput_stats);
16962306a36Sopenharmony_ci	mutex_init(&thread_lock);
17062306a36Sopenharmony_ci	cond_init(&thread_parent);
17162306a36Sopenharmony_ci	cond_init(&thread_worker);
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_ci	threads_starting = params.nthreads;
17462306a36Sopenharmony_ci	pthread_attr_init(&thread_attr);
17562306a36Sopenharmony_ci	gettimeofday(&bench__start, NULL);
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	nrcpus = perf_cpu_map__nr(cpu);
17862306a36Sopenharmony_ci	cpuset = CPU_ALLOC(nrcpus);
17962306a36Sopenharmony_ci	BUG_ON(!cpuset);
18062306a36Sopenharmony_ci	size = CPU_ALLOC_SIZE(nrcpus);
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_ci	for (i = 0; i < params.nthreads; i++) {
18362306a36Sopenharmony_ci		worker[i].tid = i;
18462306a36Sopenharmony_ci		worker[i].futex = calloc(params.nfutexes, sizeof(*worker[i].futex));
18562306a36Sopenharmony_ci		if (!worker[i].futex)
18662306a36Sopenharmony_ci			goto errmem;
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci		CPU_ZERO_S(size, cpuset);
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci		CPU_SET_S(perf_cpu_map__cpu(cpu, i % perf_cpu_map__nr(cpu)).cpu, size, cpuset);
19162306a36Sopenharmony_ci		ret = pthread_attr_setaffinity_np(&thread_attr, size, cpuset);
19262306a36Sopenharmony_ci		if (ret) {
19362306a36Sopenharmony_ci			CPU_FREE(cpuset);
19462306a36Sopenharmony_ci			err(EXIT_FAILURE, "pthread_attr_setaffinity_np");
19562306a36Sopenharmony_ci		}
19662306a36Sopenharmony_ci		ret = pthread_create(&worker[i].thread, &thread_attr, workerfn,
19762306a36Sopenharmony_ci				     (void *)(struct worker *) &worker[i]);
19862306a36Sopenharmony_ci		if (ret) {
19962306a36Sopenharmony_ci			CPU_FREE(cpuset);
20062306a36Sopenharmony_ci			err(EXIT_FAILURE, "pthread_create");
20162306a36Sopenharmony_ci		}
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	}
20462306a36Sopenharmony_ci	CPU_FREE(cpuset);
20562306a36Sopenharmony_ci	pthread_attr_destroy(&thread_attr);
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_ci	mutex_lock(&thread_lock);
20862306a36Sopenharmony_ci	while (threads_starting)
20962306a36Sopenharmony_ci		cond_wait(&thread_parent, &thread_lock);
21062306a36Sopenharmony_ci	cond_broadcast(&thread_worker);
21162306a36Sopenharmony_ci	mutex_unlock(&thread_lock);
21262306a36Sopenharmony_ci
21362306a36Sopenharmony_ci	sleep(params.runtime);
21462306a36Sopenharmony_ci	toggle_done(0, NULL, NULL);
21562306a36Sopenharmony_ci
21662306a36Sopenharmony_ci	for (i = 0; i < params.nthreads; i++) {
21762306a36Sopenharmony_ci		ret = pthread_join(worker[i].thread, NULL);
21862306a36Sopenharmony_ci		if (ret)
21962306a36Sopenharmony_ci			err(EXIT_FAILURE, "pthread_join");
22062306a36Sopenharmony_ci	}
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	/* cleanup & report results */
22362306a36Sopenharmony_ci	cond_destroy(&thread_parent);
22462306a36Sopenharmony_ci	cond_destroy(&thread_worker);
22562306a36Sopenharmony_ci	mutex_destroy(&thread_lock);
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_ci	for (i = 0; i < params.nthreads; i++) {
22862306a36Sopenharmony_ci		unsigned long t = bench__runtime.tv_sec > 0 ?
22962306a36Sopenharmony_ci			worker[i].ops / bench__runtime.tv_sec : 0;
23062306a36Sopenharmony_ci		update_stats(&throughput_stats, t);
23162306a36Sopenharmony_ci		if (!params.silent) {
23262306a36Sopenharmony_ci			if (params.nfutexes == 1)
23362306a36Sopenharmony_ci				printf("[thread %2d] futex: %p [ %ld ops/sec ]\n",
23462306a36Sopenharmony_ci				       worker[i].tid, &worker[i].futex[0], t);
23562306a36Sopenharmony_ci			else
23662306a36Sopenharmony_ci				printf("[thread %2d] futexes: %p ... %p [ %ld ops/sec ]\n",
23762306a36Sopenharmony_ci				       worker[i].tid, &worker[i].futex[0],
23862306a36Sopenharmony_ci				       &worker[i].futex[params.nfutexes-1], t);
23962306a36Sopenharmony_ci		}
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_ci		zfree(&worker[i].futex);
24262306a36Sopenharmony_ci	}
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	print_summary();
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci	free(worker);
24762306a36Sopenharmony_ci	free(cpu);
24862306a36Sopenharmony_ci	return ret;
24962306a36Sopenharmony_cierrmem:
25062306a36Sopenharmony_ci	err(EXIT_FAILURE, "calloc");
25162306a36Sopenharmony_ci}
252