162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright 2014, Michael Ellerman, IBM Corp.
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#define _GNU_SOURCE	/* For CPU_ZERO etc. */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <errno.h>
962306a36Sopenharmony_ci#include <sched.h>
1062306a36Sopenharmony_ci#include <setjmp.h>
1162306a36Sopenharmony_ci#include <stdlib.h>
1262306a36Sopenharmony_ci#include <sys/wait.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include "utils.h"
1562306a36Sopenharmony_ci#include "lib.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define PARENT_TOKEN	0xAA
1862306a36Sopenharmony_ci#define CHILD_TOKEN	0x55
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ciint sync_with_child(union pipe read_pipe, union pipe write_pipe)
2162306a36Sopenharmony_ci{
2262306a36Sopenharmony_ci	char c = PARENT_TOKEN;
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci	FAIL_IF(write(write_pipe.write_fd, &c, 1) != 1);
2562306a36Sopenharmony_ci	FAIL_IF(read(read_pipe.read_fd, &c, 1) != 1);
2662306a36Sopenharmony_ci	if (c != CHILD_TOKEN) /* sometimes expected */
2762306a36Sopenharmony_ci		return 1;
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	return 0;
3062306a36Sopenharmony_ci}
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ciint wait_for_parent(union pipe read_pipe)
3362306a36Sopenharmony_ci{
3462306a36Sopenharmony_ci	char c;
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_ci	FAIL_IF(read(read_pipe.read_fd, &c, 1) != 1);
3762306a36Sopenharmony_ci	FAIL_IF(c != PARENT_TOKEN);
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci	return 0;
4062306a36Sopenharmony_ci}
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ciint notify_parent(union pipe write_pipe)
4362306a36Sopenharmony_ci{
4462306a36Sopenharmony_ci	char c = CHILD_TOKEN;
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci	FAIL_IF(write(write_pipe.write_fd, &c, 1) != 1);
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci	return 0;
4962306a36Sopenharmony_ci}
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ciint notify_parent_of_error(union pipe write_pipe)
5262306a36Sopenharmony_ci{
5362306a36Sopenharmony_ci	char c = ~CHILD_TOKEN;
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ci	FAIL_IF(write(write_pipe.write_fd, &c, 1) != 1);
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ci	return 0;
5862306a36Sopenharmony_ci}
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ciint wait_for_child(pid_t child_pid)
6162306a36Sopenharmony_ci{
6262306a36Sopenharmony_ci	int rc;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	if (waitpid(child_pid, &rc, 0) == -1) {
6562306a36Sopenharmony_ci		perror("waitpid");
6662306a36Sopenharmony_ci		return 1;
6762306a36Sopenharmony_ci	}
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	if (WIFEXITED(rc))
7062306a36Sopenharmony_ci		rc = WEXITSTATUS(rc);
7162306a36Sopenharmony_ci	else
7262306a36Sopenharmony_ci		rc = 1; /* Signal or other */
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_ci	return rc;
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ciint kill_child_and_wait(pid_t child_pid)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	kill(child_pid, SIGTERM);
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	return wait_for_child(child_pid);
8262306a36Sopenharmony_ci}
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_cistatic int eat_cpu_child(union pipe read_pipe, union pipe write_pipe)
8562306a36Sopenharmony_ci{
8662306a36Sopenharmony_ci	volatile int i = 0;
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	/*
8962306a36Sopenharmony_ci	 * We are just here to eat cpu and die. So make sure we can be killed,
9062306a36Sopenharmony_ci	 * and also don't do any custom SIGTERM handling.
9162306a36Sopenharmony_ci	 */
9262306a36Sopenharmony_ci	signal(SIGTERM, SIG_DFL);
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	notify_parent(write_pipe);
9562306a36Sopenharmony_ci	wait_for_parent(read_pipe);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	/* Soak up cpu forever */
9862306a36Sopenharmony_ci	while (1) i++;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	return 0;
10162306a36Sopenharmony_ci}
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_cipid_t eat_cpu(int (test_function)(void))
10462306a36Sopenharmony_ci{
10562306a36Sopenharmony_ci	union pipe read_pipe, write_pipe;
10662306a36Sopenharmony_ci	int rc;
10762306a36Sopenharmony_ci	pid_t pid;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	FAIL_IF(bind_to_cpu(BIND_CPU_ANY) < 0);
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci	if (pipe(read_pipe.fds) == -1)
11262306a36Sopenharmony_ci		return -1;
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	if (pipe(write_pipe.fds) == -1)
11562306a36Sopenharmony_ci		return -1;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	pid = fork();
11862306a36Sopenharmony_ci	if (pid == 0)
11962306a36Sopenharmony_ci		exit(eat_cpu_child(write_pipe, read_pipe));
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	if (sync_with_child(read_pipe, write_pipe)) {
12262306a36Sopenharmony_ci		rc = -1;
12362306a36Sopenharmony_ci		goto out;
12462306a36Sopenharmony_ci	}
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci	printf("main test running as pid %d\n", getpid());
12762306a36Sopenharmony_ci
12862306a36Sopenharmony_ci	rc = test_function();
12962306a36Sopenharmony_ciout:
13062306a36Sopenharmony_ci	kill(pid, SIGKILL);
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci	return rc;
13362306a36Sopenharmony_ci}
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_cistruct addr_range libc, vdso;
13662306a36Sopenharmony_ci
13762306a36Sopenharmony_ciint parse_proc_maps(void)
13862306a36Sopenharmony_ci{
13962306a36Sopenharmony_ci	unsigned long start, end;
14062306a36Sopenharmony_ci	char execute, name[128];
14162306a36Sopenharmony_ci	FILE *f;
14262306a36Sopenharmony_ci	int rc;
14362306a36Sopenharmony_ci
14462306a36Sopenharmony_ci	f = fopen("/proc/self/maps", "r");
14562306a36Sopenharmony_ci	if (!f) {
14662306a36Sopenharmony_ci		perror("fopen");
14762306a36Sopenharmony_ci		return -1;
14862306a36Sopenharmony_ci	}
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci	do {
15162306a36Sopenharmony_ci		/* This skips line with no executable which is what we want */
15262306a36Sopenharmony_ci		rc = fscanf(f, "%lx-%lx %*c%*c%c%*c %*x %*d:%*d %*d %127s\n",
15362306a36Sopenharmony_ci			    &start, &end, &execute, name);
15462306a36Sopenharmony_ci		if (rc <= 0)
15562306a36Sopenharmony_ci			break;
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci		if (execute != 'x')
15862306a36Sopenharmony_ci			continue;
15962306a36Sopenharmony_ci
16062306a36Sopenharmony_ci		if (strstr(name, "libc")) {
16162306a36Sopenharmony_ci			libc.first = start;
16262306a36Sopenharmony_ci			libc.last = end - 1;
16362306a36Sopenharmony_ci		} else if (strstr(name, "[vdso]")) {
16462306a36Sopenharmony_ci			vdso.first = start;
16562306a36Sopenharmony_ci			vdso.last = end - 1;
16662306a36Sopenharmony_ci		}
16762306a36Sopenharmony_ci	} while(1);
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	fclose(f);
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	return 0;
17262306a36Sopenharmony_ci}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci#define PARANOID_PATH	"/proc/sys/kernel/perf_event_paranoid"
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_cibool require_paranoia_below(int level)
17762306a36Sopenharmony_ci{
17862306a36Sopenharmony_ci	int err;
17962306a36Sopenharmony_ci	long current;
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	err = read_long(PARANOID_PATH, &current, 10);
18262306a36Sopenharmony_ci	if (err) {
18362306a36Sopenharmony_ci		printf("Couldn't parse " PARANOID_PATH "?\n");
18462306a36Sopenharmony_ci		return false;
18562306a36Sopenharmony_ci	}
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	return current < level;
18862306a36Sopenharmony_ci}
189