18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Test null syscall performance
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2009-2015 Anton Blanchard, IBM
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#define NR_LOOPS 10000000
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ci#include <string.h>
118c2ecf20Sopenharmony_ci#include <stdio.h>
128c2ecf20Sopenharmony_ci#include <stdlib.h>
138c2ecf20Sopenharmony_ci#include <unistd.h>
148c2ecf20Sopenharmony_ci#include <time.h>
158c2ecf20Sopenharmony_ci#include <sys/types.h>
168c2ecf20Sopenharmony_ci#include <sys/time.h>
178c2ecf20Sopenharmony_ci#include <signal.h>
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_cistatic volatile int soak_done;
208c2ecf20Sopenharmony_ciunsigned long long clock_frequency;
218c2ecf20Sopenharmony_ciunsigned long long timebase_frequency;
228c2ecf20Sopenharmony_cidouble timebase_multiplier;
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_cistatic inline unsigned long mftb(void)
258c2ecf20Sopenharmony_ci{
268c2ecf20Sopenharmony_ci	unsigned long low;
278c2ecf20Sopenharmony_ci
288c2ecf20Sopenharmony_ci	asm volatile("mftb %0" : "=r" (low));
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci	return low;
318c2ecf20Sopenharmony_ci}
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_cistatic void sigalrm_handler(int unused)
348c2ecf20Sopenharmony_ci{
358c2ecf20Sopenharmony_ci	soak_done = 1;
368c2ecf20Sopenharmony_ci}
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci/*
398c2ecf20Sopenharmony_ci * Use a timer instead of busy looping on clock_gettime() so we don't
408c2ecf20Sopenharmony_ci * pollute profiles with glibc and VDSO hits.
418c2ecf20Sopenharmony_ci */
428c2ecf20Sopenharmony_cistatic void cpu_soak_usecs(unsigned long usecs)
438c2ecf20Sopenharmony_ci{
448c2ecf20Sopenharmony_ci	struct itimerval val;
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_ci	memset(&val, 0, sizeof(val));
478c2ecf20Sopenharmony_ci	val.it_value.tv_usec = usecs;
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	signal(SIGALRM, sigalrm_handler);
508c2ecf20Sopenharmony_ci	setitimer(ITIMER_REAL, &val, NULL);
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci	while (1) {
538c2ecf20Sopenharmony_ci		if (soak_done)
548c2ecf20Sopenharmony_ci			break;
558c2ecf20Sopenharmony_ci	}
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci	signal(SIGALRM, SIG_DFL);
588c2ecf20Sopenharmony_ci}
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_ci/*
618c2ecf20Sopenharmony_ci * This only works with recent kernels where cpufreq modifies
628c2ecf20Sopenharmony_ci * /proc/cpuinfo dynamically.
638c2ecf20Sopenharmony_ci */
648c2ecf20Sopenharmony_cistatic void get_proc_frequency(void)
658c2ecf20Sopenharmony_ci{
668c2ecf20Sopenharmony_ci	FILE *f;
678c2ecf20Sopenharmony_ci	char line[128];
688c2ecf20Sopenharmony_ci	char *p, *end;
698c2ecf20Sopenharmony_ci	unsigned long v;
708c2ecf20Sopenharmony_ci	double d;
718c2ecf20Sopenharmony_ci	char *override;
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci	/* Try to get out of low power/low frequency mode */
748c2ecf20Sopenharmony_ci	cpu_soak_usecs(0.25 * 1000000);
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci	f = fopen("/proc/cpuinfo", "r");
778c2ecf20Sopenharmony_ci	if (f == NULL)
788c2ecf20Sopenharmony_ci		return;
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_ci	timebase_frequency = 0;
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_ci	while (fgets(line, sizeof(line), f) != NULL) {
838c2ecf20Sopenharmony_ci		if (strncmp(line, "timebase", 8) == 0) {
848c2ecf20Sopenharmony_ci			p = strchr(line, ':');
858c2ecf20Sopenharmony_ci			if (p != NULL) {
868c2ecf20Sopenharmony_ci				v = strtoull(p + 1, &end, 0);
878c2ecf20Sopenharmony_ci				if (end != p + 1)
888c2ecf20Sopenharmony_ci					timebase_frequency = v;
898c2ecf20Sopenharmony_ci			}
908c2ecf20Sopenharmony_ci		}
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci		if (((strncmp(line, "clock", 5) == 0) ||
938c2ecf20Sopenharmony_ci		     (strncmp(line, "cpu MHz", 7) == 0))) {
948c2ecf20Sopenharmony_ci			p = strchr(line, ':');
958c2ecf20Sopenharmony_ci			if (p != NULL) {
968c2ecf20Sopenharmony_ci				d = strtod(p + 1, &end);
978c2ecf20Sopenharmony_ci				if (end != p + 1) {
988c2ecf20Sopenharmony_ci					/* Find fastest clock frequency */
998c2ecf20Sopenharmony_ci					if ((d * 1000000ULL) > clock_frequency)
1008c2ecf20Sopenharmony_ci						clock_frequency = d * 1000000ULL;
1018c2ecf20Sopenharmony_ci				}
1028c2ecf20Sopenharmony_ci			}
1038c2ecf20Sopenharmony_ci		}
1048c2ecf20Sopenharmony_ci	}
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci	fclose(f);
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_ci	override = getenv("FREQUENCY");
1098c2ecf20Sopenharmony_ci	if (override)
1108c2ecf20Sopenharmony_ci		clock_frequency = strtoull(override, NULL, 10);
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	if (timebase_frequency)
1138c2ecf20Sopenharmony_ci		timebase_multiplier = (double)clock_frequency
1148c2ecf20Sopenharmony_ci					/ timebase_frequency;
1158c2ecf20Sopenharmony_ci	else
1168c2ecf20Sopenharmony_ci		timebase_multiplier = 1;
1178c2ecf20Sopenharmony_ci}
1188c2ecf20Sopenharmony_ci
1198c2ecf20Sopenharmony_cistatic void do_null_syscall(unsigned long nr)
1208c2ecf20Sopenharmony_ci{
1218c2ecf20Sopenharmony_ci	unsigned long i;
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	for (i = 0; i < nr; i++)
1248c2ecf20Sopenharmony_ci		getppid();
1258c2ecf20Sopenharmony_ci}
1268c2ecf20Sopenharmony_ci
1278c2ecf20Sopenharmony_ci#define TIME(A, STR) \
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ciint main(void)
1308c2ecf20Sopenharmony_ci{
1318c2ecf20Sopenharmony_ci	unsigned long tb_start, tb_now;
1328c2ecf20Sopenharmony_ci	struct timespec tv_start, tv_now;
1338c2ecf20Sopenharmony_ci	unsigned long long elapsed_ns, elapsed_tb;
1348c2ecf20Sopenharmony_ci
1358c2ecf20Sopenharmony_ci	get_proc_frequency();
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_ci	clock_gettime(CLOCK_MONOTONIC, &tv_start);
1388c2ecf20Sopenharmony_ci	tb_start = mftb();
1398c2ecf20Sopenharmony_ci
1408c2ecf20Sopenharmony_ci	do_null_syscall(NR_LOOPS);
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci	clock_gettime(CLOCK_MONOTONIC, &tv_now);
1438c2ecf20Sopenharmony_ci	tb_now = mftb();
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_ci	elapsed_ns = (tv_now.tv_sec - tv_start.tv_sec) * 1000000000ULL +
1468c2ecf20Sopenharmony_ci			(tv_now.tv_nsec - tv_start.tv_nsec);
1478c2ecf20Sopenharmony_ci	elapsed_tb = tb_now - tb_start;
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_ci	printf("%10.2f ns %10.2f cycles\n", (float)elapsed_ns / NR_LOOPS,
1508c2ecf20Sopenharmony_ci			(float)elapsed_tb * timebase_multiplier / NR_LOOPS);
1518c2ecf20Sopenharmony_ci
1528c2ecf20Sopenharmony_ci	return 0;
1538c2ecf20Sopenharmony_ci}
154