162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
262306a36Sopenharmony_ci
362306a36Sopenharmony_ci#define _GNU_SOURCE
462306a36Sopenharmony_ci
562306a36Sopenharmony_ci#include <stdio.h>
662306a36Sopenharmony_ci#include <sys/time.h>
762306a36Sopenharmony_ci#include <time.h>
862306a36Sopenharmony_ci#include <stdlib.h>
962306a36Sopenharmony_ci#include <sys/syscall.h>
1062306a36Sopenharmony_ci#include <unistd.h>
1162306a36Sopenharmony_ci#include <dlfcn.h>
1262306a36Sopenharmony_ci#include <string.h>
1362306a36Sopenharmony_ci#include <inttypes.h>
1462306a36Sopenharmony_ci#include <signal.h>
1562306a36Sopenharmony_ci#include <sys/ucontext.h>
1662306a36Sopenharmony_ci#include <errno.h>
1762306a36Sopenharmony_ci#include <err.h>
1862306a36Sopenharmony_ci#include <sched.h>
1962306a36Sopenharmony_ci#include <stdbool.h>
2062306a36Sopenharmony_ci#include <setjmp.h>
2162306a36Sopenharmony_ci#include <sys/uio.h>
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#include "helpers.h"
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#ifdef __x86_64__
2662306a36Sopenharmony_ci# define VSYS(x) (x)
2762306a36Sopenharmony_ci#else
2862306a36Sopenharmony_ci# define VSYS(x) 0
2962306a36Sopenharmony_ci#endif
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#ifndef SYS_getcpu
3262306a36Sopenharmony_ci# ifdef __x86_64__
3362306a36Sopenharmony_ci#  define SYS_getcpu 309
3462306a36Sopenharmony_ci# else
3562306a36Sopenharmony_ci#  define SYS_getcpu 318
3662306a36Sopenharmony_ci# endif
3762306a36Sopenharmony_ci#endif
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci/* max length of lines in /proc/self/maps - anything longer is skipped here */
4062306a36Sopenharmony_ci#define MAPS_LINE_LEN 128
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_cistatic void sethandler(int sig, void (*handler)(int, siginfo_t *, void *),
4362306a36Sopenharmony_ci		       int flags)
4462306a36Sopenharmony_ci{
4562306a36Sopenharmony_ci	struct sigaction sa;
4662306a36Sopenharmony_ci	memset(&sa, 0, sizeof(sa));
4762306a36Sopenharmony_ci	sa.sa_sigaction = handler;
4862306a36Sopenharmony_ci	sa.sa_flags = SA_SIGINFO | flags;
4962306a36Sopenharmony_ci	sigemptyset(&sa.sa_mask);
5062306a36Sopenharmony_ci	if (sigaction(sig, &sa, 0))
5162306a36Sopenharmony_ci		err(1, "sigaction");
5262306a36Sopenharmony_ci}
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci/* vsyscalls and vDSO */
5562306a36Sopenharmony_cibool vsyscall_map_r = false, vsyscall_map_x = false;
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_citypedef long (*gtod_t)(struct timeval *tv, struct timezone *tz);
5862306a36Sopenharmony_ciconst gtod_t vgtod = (gtod_t)VSYS(0xffffffffff600000);
5962306a36Sopenharmony_cigtod_t vdso_gtod;
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_citypedef int (*vgettime_t)(clockid_t, struct timespec *);
6262306a36Sopenharmony_civgettime_t vdso_gettime;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_citypedef long (*time_func_t)(time_t *t);
6562306a36Sopenharmony_ciconst time_func_t vtime = (time_func_t)VSYS(0xffffffffff600400);
6662306a36Sopenharmony_citime_func_t vdso_time;
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_citypedef long (*getcpu_t)(unsigned *, unsigned *, void *);
6962306a36Sopenharmony_ciconst getcpu_t vgetcpu = (getcpu_t)VSYS(0xffffffffff600800);
7062306a36Sopenharmony_cigetcpu_t vdso_getcpu;
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_cistatic void init_vdso(void)
7362306a36Sopenharmony_ci{
7462306a36Sopenharmony_ci	void *vdso = dlopen("linux-vdso.so.1", RTLD_LAZY | RTLD_LOCAL | RTLD_NOLOAD);
7562306a36Sopenharmony_ci	if (!vdso)
7662306a36Sopenharmony_ci		vdso = dlopen("linux-gate.so.1", RTLD_LAZY | RTLD_LOCAL | RTLD_NOLOAD);
7762306a36Sopenharmony_ci	if (!vdso) {
7862306a36Sopenharmony_ci		printf("[WARN]\tfailed to find vDSO\n");
7962306a36Sopenharmony_ci		return;
8062306a36Sopenharmony_ci	}
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	vdso_gtod = (gtod_t)dlsym(vdso, "__vdso_gettimeofday");
8362306a36Sopenharmony_ci	if (!vdso_gtod)
8462306a36Sopenharmony_ci		printf("[WARN]\tfailed to find gettimeofday in vDSO\n");
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_ci	vdso_gettime = (vgettime_t)dlsym(vdso, "__vdso_clock_gettime");
8762306a36Sopenharmony_ci	if (!vdso_gettime)
8862306a36Sopenharmony_ci		printf("[WARN]\tfailed to find clock_gettime in vDSO\n");
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	vdso_time = (time_func_t)dlsym(vdso, "__vdso_time");
9162306a36Sopenharmony_ci	if (!vdso_time)
9262306a36Sopenharmony_ci		printf("[WARN]\tfailed to find time in vDSO\n");
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	vdso_getcpu = (getcpu_t)dlsym(vdso, "__vdso_getcpu");
9562306a36Sopenharmony_ci	if (!vdso_getcpu)
9662306a36Sopenharmony_ci		printf("[WARN]\tfailed to find getcpu in vDSO\n");
9762306a36Sopenharmony_ci}
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_cistatic int init_vsys(void)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci#ifdef __x86_64__
10262306a36Sopenharmony_ci	int nerrs = 0;
10362306a36Sopenharmony_ci	FILE *maps;
10462306a36Sopenharmony_ci	char line[MAPS_LINE_LEN];
10562306a36Sopenharmony_ci	bool found = false;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	maps = fopen("/proc/self/maps", "r");
10862306a36Sopenharmony_ci	if (!maps) {
10962306a36Sopenharmony_ci		printf("[WARN]\tCould not open /proc/self/maps -- assuming vsyscall is r-x\n");
11062306a36Sopenharmony_ci		vsyscall_map_r = true;
11162306a36Sopenharmony_ci		return 0;
11262306a36Sopenharmony_ci	}
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	while (fgets(line, MAPS_LINE_LEN, maps)) {
11562306a36Sopenharmony_ci		char r, x;
11662306a36Sopenharmony_ci		void *start, *end;
11762306a36Sopenharmony_ci		char name[MAPS_LINE_LEN];
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci		/* sscanf() is safe here as strlen(name) >= strlen(line) */
12062306a36Sopenharmony_ci		if (sscanf(line, "%p-%p %c-%cp %*x %*x:%*x %*u %s",
12162306a36Sopenharmony_ci			   &start, &end, &r, &x, name) != 5)
12262306a36Sopenharmony_ci			continue;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci		if (strcmp(name, "[vsyscall]"))
12562306a36Sopenharmony_ci			continue;
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci		printf("\tvsyscall map: %s", line);
12862306a36Sopenharmony_ci
12962306a36Sopenharmony_ci		if (start != (void *)0xffffffffff600000 ||
13062306a36Sopenharmony_ci		    end != (void *)0xffffffffff601000) {
13162306a36Sopenharmony_ci			printf("[FAIL]\taddress range is nonsense\n");
13262306a36Sopenharmony_ci			nerrs++;
13362306a36Sopenharmony_ci		}
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci		printf("\tvsyscall permissions are %c-%c\n", r, x);
13662306a36Sopenharmony_ci		vsyscall_map_r = (r == 'r');
13762306a36Sopenharmony_ci		vsyscall_map_x = (x == 'x');
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci		found = true;
14062306a36Sopenharmony_ci		break;
14162306a36Sopenharmony_ci	}
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	fclose(maps);
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	if (!found) {
14662306a36Sopenharmony_ci		printf("\tno vsyscall map in /proc/self/maps\n");
14762306a36Sopenharmony_ci		vsyscall_map_r = false;
14862306a36Sopenharmony_ci		vsyscall_map_x = false;
14962306a36Sopenharmony_ci	}
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	return nerrs;
15262306a36Sopenharmony_ci#else
15362306a36Sopenharmony_ci	return 0;
15462306a36Sopenharmony_ci#endif
15562306a36Sopenharmony_ci}
15662306a36Sopenharmony_ci
15762306a36Sopenharmony_ci/* syscalls */
15862306a36Sopenharmony_cistatic inline long sys_gtod(struct timeval *tv, struct timezone *tz)
15962306a36Sopenharmony_ci{
16062306a36Sopenharmony_ci	return syscall(SYS_gettimeofday, tv, tz);
16162306a36Sopenharmony_ci}
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_cistatic inline int sys_clock_gettime(clockid_t id, struct timespec *ts)
16462306a36Sopenharmony_ci{
16562306a36Sopenharmony_ci	return syscall(SYS_clock_gettime, id, ts);
16662306a36Sopenharmony_ci}
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_cistatic inline long sys_time(time_t *t)
16962306a36Sopenharmony_ci{
17062306a36Sopenharmony_ci	return syscall(SYS_time, t);
17162306a36Sopenharmony_ci}
17262306a36Sopenharmony_ci
17362306a36Sopenharmony_cistatic inline long sys_getcpu(unsigned * cpu, unsigned * node,
17462306a36Sopenharmony_ci			      void* cache)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	return syscall(SYS_getcpu, cpu, node, cache);
17762306a36Sopenharmony_ci}
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_cistatic jmp_buf jmpbuf;
18062306a36Sopenharmony_cistatic volatile unsigned long segv_err;
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_cistatic void sigsegv(int sig, siginfo_t *info, void *ctx_void)
18362306a36Sopenharmony_ci{
18462306a36Sopenharmony_ci	ucontext_t *ctx = (ucontext_t *)ctx_void;
18562306a36Sopenharmony_ci
18662306a36Sopenharmony_ci	segv_err =  ctx->uc_mcontext.gregs[REG_ERR];
18762306a36Sopenharmony_ci	siglongjmp(jmpbuf, 1);
18862306a36Sopenharmony_ci}
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_cistatic double tv_diff(const struct timeval *a, const struct timeval *b)
19162306a36Sopenharmony_ci{
19262306a36Sopenharmony_ci	return (double)(a->tv_sec - b->tv_sec) +
19362306a36Sopenharmony_ci		(double)((int)a->tv_usec - (int)b->tv_usec) * 1e-6;
19462306a36Sopenharmony_ci}
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_cistatic int check_gtod(const struct timeval *tv_sys1,
19762306a36Sopenharmony_ci		      const struct timeval *tv_sys2,
19862306a36Sopenharmony_ci		      const struct timezone *tz_sys,
19962306a36Sopenharmony_ci		      const char *which,
20062306a36Sopenharmony_ci		      const struct timeval *tv_other,
20162306a36Sopenharmony_ci		      const struct timezone *tz_other)
20262306a36Sopenharmony_ci{
20362306a36Sopenharmony_ci	int nerrs = 0;
20462306a36Sopenharmony_ci	double d1, d2;
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_ci	if (tz_other && (tz_sys->tz_minuteswest != tz_other->tz_minuteswest || tz_sys->tz_dsttime != tz_other->tz_dsttime)) {
20762306a36Sopenharmony_ci		printf("[FAIL] %s tz mismatch\n", which);
20862306a36Sopenharmony_ci		nerrs++;
20962306a36Sopenharmony_ci	}
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci	d1 = tv_diff(tv_other, tv_sys1);
21262306a36Sopenharmony_ci	d2 = tv_diff(tv_sys2, tv_other);
21362306a36Sopenharmony_ci	printf("\t%s time offsets: %lf %lf\n", which, d1, d2);
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	if (d1 < 0 || d2 < 0) {
21662306a36Sopenharmony_ci		printf("[FAIL]\t%s time was inconsistent with the syscall\n", which);
21762306a36Sopenharmony_ci		nerrs++;
21862306a36Sopenharmony_ci	} else {
21962306a36Sopenharmony_ci		printf("[OK]\t%s gettimeofday()'s timeval was okay\n", which);
22062306a36Sopenharmony_ci	}
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	return nerrs;
22362306a36Sopenharmony_ci}
22462306a36Sopenharmony_ci
22562306a36Sopenharmony_cistatic int test_gtod(void)
22662306a36Sopenharmony_ci{
22762306a36Sopenharmony_ci	struct timeval tv_sys1, tv_sys2, tv_vdso, tv_vsys;
22862306a36Sopenharmony_ci	struct timezone tz_sys, tz_vdso, tz_vsys;
22962306a36Sopenharmony_ci	long ret_vdso = -1;
23062306a36Sopenharmony_ci	long ret_vsys = -1;
23162306a36Sopenharmony_ci	int nerrs = 0;
23262306a36Sopenharmony_ci
23362306a36Sopenharmony_ci	printf("[RUN]\ttest gettimeofday()\n");
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci	if (sys_gtod(&tv_sys1, &tz_sys) != 0)
23662306a36Sopenharmony_ci		err(1, "syscall gettimeofday");
23762306a36Sopenharmony_ci	if (vdso_gtod)
23862306a36Sopenharmony_ci		ret_vdso = vdso_gtod(&tv_vdso, &tz_vdso);
23962306a36Sopenharmony_ci	if (vsyscall_map_x)
24062306a36Sopenharmony_ci		ret_vsys = vgtod(&tv_vsys, &tz_vsys);
24162306a36Sopenharmony_ci	if (sys_gtod(&tv_sys2, &tz_sys) != 0)
24262306a36Sopenharmony_ci		err(1, "syscall gettimeofday");
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci	if (vdso_gtod) {
24562306a36Sopenharmony_ci		if (ret_vdso == 0) {
24662306a36Sopenharmony_ci			nerrs += check_gtod(&tv_sys1, &tv_sys2, &tz_sys, "vDSO", &tv_vdso, &tz_vdso);
24762306a36Sopenharmony_ci		} else {
24862306a36Sopenharmony_ci			printf("[FAIL]\tvDSO gettimeofday() failed: %ld\n", ret_vdso);
24962306a36Sopenharmony_ci			nerrs++;
25062306a36Sopenharmony_ci		}
25162306a36Sopenharmony_ci	}
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	if (vsyscall_map_x) {
25462306a36Sopenharmony_ci		if (ret_vsys == 0) {
25562306a36Sopenharmony_ci			nerrs += check_gtod(&tv_sys1, &tv_sys2, &tz_sys, "vsyscall", &tv_vsys, &tz_vsys);
25662306a36Sopenharmony_ci		} else {
25762306a36Sopenharmony_ci			printf("[FAIL]\tvsys gettimeofday() failed: %ld\n", ret_vsys);
25862306a36Sopenharmony_ci			nerrs++;
25962306a36Sopenharmony_ci		}
26062306a36Sopenharmony_ci	}
26162306a36Sopenharmony_ci
26262306a36Sopenharmony_ci	return nerrs;
26362306a36Sopenharmony_ci}
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_cistatic int test_time(void) {
26662306a36Sopenharmony_ci	int nerrs = 0;
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci	printf("[RUN]\ttest time()\n");
26962306a36Sopenharmony_ci	long t_sys1, t_sys2, t_vdso = 0, t_vsys = 0;
27062306a36Sopenharmony_ci	long t2_sys1 = -1, t2_sys2 = -1, t2_vdso = -1, t2_vsys = -1;
27162306a36Sopenharmony_ci	t_sys1 = sys_time(&t2_sys1);
27262306a36Sopenharmony_ci	if (vdso_time)
27362306a36Sopenharmony_ci		t_vdso = vdso_time(&t2_vdso);
27462306a36Sopenharmony_ci	if (vsyscall_map_x)
27562306a36Sopenharmony_ci		t_vsys = vtime(&t2_vsys);
27662306a36Sopenharmony_ci	t_sys2 = sys_time(&t2_sys2);
27762306a36Sopenharmony_ci	if (t_sys1 < 0 || t_sys1 != t2_sys1 || t_sys2 < 0 || t_sys2 != t2_sys2) {
27862306a36Sopenharmony_ci		printf("[FAIL]\tsyscall failed (ret1:%ld output1:%ld ret2:%ld output2:%ld)\n", t_sys1, t2_sys1, t_sys2, t2_sys2);
27962306a36Sopenharmony_ci		nerrs++;
28062306a36Sopenharmony_ci		return nerrs;
28162306a36Sopenharmony_ci	}
28262306a36Sopenharmony_ci
28362306a36Sopenharmony_ci	if (vdso_time) {
28462306a36Sopenharmony_ci		if (t_vdso < 0 || t_vdso != t2_vdso) {
28562306a36Sopenharmony_ci			printf("[FAIL]\tvDSO failed (ret:%ld output:%ld)\n", t_vdso, t2_vdso);
28662306a36Sopenharmony_ci			nerrs++;
28762306a36Sopenharmony_ci		} else if (t_vdso < t_sys1 || t_vdso > t_sys2) {
28862306a36Sopenharmony_ci			printf("[FAIL]\tvDSO returned the wrong time (%ld %ld %ld)\n", t_sys1, t_vdso, t_sys2);
28962306a36Sopenharmony_ci			nerrs++;
29062306a36Sopenharmony_ci		} else {
29162306a36Sopenharmony_ci			printf("[OK]\tvDSO time() is okay\n");
29262306a36Sopenharmony_ci		}
29362306a36Sopenharmony_ci	}
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci	if (vsyscall_map_x) {
29662306a36Sopenharmony_ci		if (t_vsys < 0 || t_vsys != t2_vsys) {
29762306a36Sopenharmony_ci			printf("[FAIL]\tvsyscall failed (ret:%ld output:%ld)\n", t_vsys, t2_vsys);
29862306a36Sopenharmony_ci			nerrs++;
29962306a36Sopenharmony_ci		} else if (t_vsys < t_sys1 || t_vsys > t_sys2) {
30062306a36Sopenharmony_ci			printf("[FAIL]\tvsyscall returned the wrong time (%ld %ld %ld)\n", t_sys1, t_vsys, t_sys2);
30162306a36Sopenharmony_ci			nerrs++;
30262306a36Sopenharmony_ci		} else {
30362306a36Sopenharmony_ci			printf("[OK]\tvsyscall time() is okay\n");
30462306a36Sopenharmony_ci		}
30562306a36Sopenharmony_ci	}
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci	return nerrs;
30862306a36Sopenharmony_ci}
30962306a36Sopenharmony_ci
31062306a36Sopenharmony_cistatic int test_getcpu(int cpu)
31162306a36Sopenharmony_ci{
31262306a36Sopenharmony_ci	int nerrs = 0;
31362306a36Sopenharmony_ci	long ret_sys, ret_vdso = -1, ret_vsys = -1;
31462306a36Sopenharmony_ci
31562306a36Sopenharmony_ci	printf("[RUN]\tgetcpu() on CPU %d\n", cpu);
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_ci	cpu_set_t cpuset;
31862306a36Sopenharmony_ci	CPU_ZERO(&cpuset);
31962306a36Sopenharmony_ci	CPU_SET(cpu, &cpuset);
32062306a36Sopenharmony_ci	if (sched_setaffinity(0, sizeof(cpuset), &cpuset) != 0) {
32162306a36Sopenharmony_ci		printf("[SKIP]\tfailed to force CPU %d\n", cpu);
32262306a36Sopenharmony_ci		return nerrs;
32362306a36Sopenharmony_ci	}
32462306a36Sopenharmony_ci
32562306a36Sopenharmony_ci	unsigned cpu_sys, cpu_vdso, cpu_vsys, node_sys, node_vdso, node_vsys;
32662306a36Sopenharmony_ci	unsigned node = 0;
32762306a36Sopenharmony_ci	bool have_node = false;
32862306a36Sopenharmony_ci	ret_sys = sys_getcpu(&cpu_sys, &node_sys, 0);
32962306a36Sopenharmony_ci	if (vdso_getcpu)
33062306a36Sopenharmony_ci		ret_vdso = vdso_getcpu(&cpu_vdso, &node_vdso, 0);
33162306a36Sopenharmony_ci	if (vsyscall_map_x)
33262306a36Sopenharmony_ci		ret_vsys = vgetcpu(&cpu_vsys, &node_vsys, 0);
33362306a36Sopenharmony_ci
33462306a36Sopenharmony_ci	if (ret_sys == 0) {
33562306a36Sopenharmony_ci		if (cpu_sys != cpu) {
33662306a36Sopenharmony_ci			printf("[FAIL]\tsyscall reported CPU %hu but should be %d\n", cpu_sys, cpu);
33762306a36Sopenharmony_ci			nerrs++;
33862306a36Sopenharmony_ci		}
33962306a36Sopenharmony_ci
34062306a36Sopenharmony_ci		have_node = true;
34162306a36Sopenharmony_ci		node = node_sys;
34262306a36Sopenharmony_ci	}
34362306a36Sopenharmony_ci
34462306a36Sopenharmony_ci	if (vdso_getcpu) {
34562306a36Sopenharmony_ci		if (ret_vdso) {
34662306a36Sopenharmony_ci			printf("[FAIL]\tvDSO getcpu() failed\n");
34762306a36Sopenharmony_ci			nerrs++;
34862306a36Sopenharmony_ci		} else {
34962306a36Sopenharmony_ci			if (!have_node) {
35062306a36Sopenharmony_ci				have_node = true;
35162306a36Sopenharmony_ci				node = node_vdso;
35262306a36Sopenharmony_ci			}
35362306a36Sopenharmony_ci
35462306a36Sopenharmony_ci			if (cpu_vdso != cpu) {
35562306a36Sopenharmony_ci				printf("[FAIL]\tvDSO reported CPU %hu but should be %d\n", cpu_vdso, cpu);
35662306a36Sopenharmony_ci				nerrs++;
35762306a36Sopenharmony_ci			} else {
35862306a36Sopenharmony_ci				printf("[OK]\tvDSO reported correct CPU\n");
35962306a36Sopenharmony_ci			}
36062306a36Sopenharmony_ci
36162306a36Sopenharmony_ci			if (node_vdso != node) {
36262306a36Sopenharmony_ci				printf("[FAIL]\tvDSO reported node %hu but should be %hu\n", node_vdso, node);
36362306a36Sopenharmony_ci				nerrs++;
36462306a36Sopenharmony_ci			} else {
36562306a36Sopenharmony_ci				printf("[OK]\tvDSO reported correct node\n");
36662306a36Sopenharmony_ci			}
36762306a36Sopenharmony_ci		}
36862306a36Sopenharmony_ci	}
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci	if (vsyscall_map_x) {
37162306a36Sopenharmony_ci		if (ret_vsys) {
37262306a36Sopenharmony_ci			printf("[FAIL]\tvsyscall getcpu() failed\n");
37362306a36Sopenharmony_ci			nerrs++;
37462306a36Sopenharmony_ci		} else {
37562306a36Sopenharmony_ci			if (!have_node) {
37662306a36Sopenharmony_ci				have_node = true;
37762306a36Sopenharmony_ci				node = node_vsys;
37862306a36Sopenharmony_ci			}
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci			if (cpu_vsys != cpu) {
38162306a36Sopenharmony_ci				printf("[FAIL]\tvsyscall reported CPU %hu but should be %d\n", cpu_vsys, cpu);
38262306a36Sopenharmony_ci				nerrs++;
38362306a36Sopenharmony_ci			} else {
38462306a36Sopenharmony_ci				printf("[OK]\tvsyscall reported correct CPU\n");
38562306a36Sopenharmony_ci			}
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci			if (node_vsys != node) {
38862306a36Sopenharmony_ci				printf("[FAIL]\tvsyscall reported node %hu but should be %hu\n", node_vsys, node);
38962306a36Sopenharmony_ci				nerrs++;
39062306a36Sopenharmony_ci			} else {
39162306a36Sopenharmony_ci				printf("[OK]\tvsyscall reported correct node\n");
39262306a36Sopenharmony_ci			}
39362306a36Sopenharmony_ci		}
39462306a36Sopenharmony_ci	}
39562306a36Sopenharmony_ci
39662306a36Sopenharmony_ci	return nerrs;
39762306a36Sopenharmony_ci}
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_cistatic int test_vsys_r(void)
40062306a36Sopenharmony_ci{
40162306a36Sopenharmony_ci#ifdef __x86_64__
40262306a36Sopenharmony_ci	printf("[RUN]\tChecking read access to the vsyscall page\n");
40362306a36Sopenharmony_ci	bool can_read;
40462306a36Sopenharmony_ci	if (sigsetjmp(jmpbuf, 1) == 0) {
40562306a36Sopenharmony_ci		*(volatile int *)0xffffffffff600000;
40662306a36Sopenharmony_ci		can_read = true;
40762306a36Sopenharmony_ci	} else {
40862306a36Sopenharmony_ci		can_read = false;
40962306a36Sopenharmony_ci	}
41062306a36Sopenharmony_ci
41162306a36Sopenharmony_ci	if (can_read && !vsyscall_map_r) {
41262306a36Sopenharmony_ci		printf("[FAIL]\tWe have read access, but we shouldn't\n");
41362306a36Sopenharmony_ci		return 1;
41462306a36Sopenharmony_ci	} else if (!can_read && vsyscall_map_r) {
41562306a36Sopenharmony_ci		printf("[FAIL]\tWe don't have read access, but we should\n");
41662306a36Sopenharmony_ci		return 1;
41762306a36Sopenharmony_ci	} else if (can_read) {
41862306a36Sopenharmony_ci		printf("[OK]\tWe have read access\n");
41962306a36Sopenharmony_ci	} else {
42062306a36Sopenharmony_ci		printf("[OK]\tWe do not have read access: #PF(0x%lx)\n",
42162306a36Sopenharmony_ci		       segv_err);
42262306a36Sopenharmony_ci	}
42362306a36Sopenharmony_ci#endif
42462306a36Sopenharmony_ci
42562306a36Sopenharmony_ci	return 0;
42662306a36Sopenharmony_ci}
42762306a36Sopenharmony_ci
42862306a36Sopenharmony_cistatic int test_vsys_x(void)
42962306a36Sopenharmony_ci{
43062306a36Sopenharmony_ci#ifdef __x86_64__
43162306a36Sopenharmony_ci	if (vsyscall_map_x) {
43262306a36Sopenharmony_ci		/* We already tested this adequately. */
43362306a36Sopenharmony_ci		return 0;
43462306a36Sopenharmony_ci	}
43562306a36Sopenharmony_ci
43662306a36Sopenharmony_ci	printf("[RUN]\tMake sure that vsyscalls really page fault\n");
43762306a36Sopenharmony_ci
43862306a36Sopenharmony_ci	bool can_exec;
43962306a36Sopenharmony_ci	if (sigsetjmp(jmpbuf, 1) == 0) {
44062306a36Sopenharmony_ci		vgtod(NULL, NULL);
44162306a36Sopenharmony_ci		can_exec = true;
44262306a36Sopenharmony_ci	} else {
44362306a36Sopenharmony_ci		can_exec = false;
44462306a36Sopenharmony_ci	}
44562306a36Sopenharmony_ci
44662306a36Sopenharmony_ci	if (can_exec) {
44762306a36Sopenharmony_ci		printf("[FAIL]\tExecuting the vsyscall did not page fault\n");
44862306a36Sopenharmony_ci		return 1;
44962306a36Sopenharmony_ci	} else if (segv_err & (1 << 4)) { /* INSTR */
45062306a36Sopenharmony_ci		printf("[OK]\tExecuting the vsyscall page failed: #PF(0x%lx)\n",
45162306a36Sopenharmony_ci		       segv_err);
45262306a36Sopenharmony_ci	} else {
45362306a36Sopenharmony_ci		printf("[FAIL]\tExecution failed with the wrong error: #PF(0x%lx)\n",
45462306a36Sopenharmony_ci		       segv_err);
45562306a36Sopenharmony_ci		return 1;
45662306a36Sopenharmony_ci	}
45762306a36Sopenharmony_ci#endif
45862306a36Sopenharmony_ci
45962306a36Sopenharmony_ci	return 0;
46062306a36Sopenharmony_ci}
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci/*
46362306a36Sopenharmony_ci * Debuggers expect ptrace() to be able to peek at the vsyscall page.
46462306a36Sopenharmony_ci * Use process_vm_readv() as a proxy for ptrace() to test this.  We
46562306a36Sopenharmony_ci * want it to work in the vsyscall=emulate case and to fail in the
46662306a36Sopenharmony_ci * vsyscall=xonly case.
46762306a36Sopenharmony_ci *
46862306a36Sopenharmony_ci * It's worth noting that this ABI is a bit nutty.  write(2) can't
46962306a36Sopenharmony_ci * read from the vsyscall page on any kernel version or mode.  The
47062306a36Sopenharmony_ci * fact that ptrace() ever worked was a nice courtesy of old kernels,
47162306a36Sopenharmony_ci * but the code to support it is fairly gross.
47262306a36Sopenharmony_ci */
47362306a36Sopenharmony_cistatic int test_process_vm_readv(void)
47462306a36Sopenharmony_ci{
47562306a36Sopenharmony_ci#ifdef __x86_64__
47662306a36Sopenharmony_ci	char buf[4096];
47762306a36Sopenharmony_ci	struct iovec local, remote;
47862306a36Sopenharmony_ci	int ret;
47962306a36Sopenharmony_ci
48062306a36Sopenharmony_ci	printf("[RUN]\tprocess_vm_readv() from vsyscall page\n");
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_ci	local.iov_base = buf;
48362306a36Sopenharmony_ci	local.iov_len = 4096;
48462306a36Sopenharmony_ci	remote.iov_base = (void *)0xffffffffff600000;
48562306a36Sopenharmony_ci	remote.iov_len = 4096;
48662306a36Sopenharmony_ci	ret = process_vm_readv(getpid(), &local, 1, &remote, 1, 0);
48762306a36Sopenharmony_ci	if (ret != 4096) {
48862306a36Sopenharmony_ci		/*
48962306a36Sopenharmony_ci		 * We expect process_vm_readv() to work if and only if the
49062306a36Sopenharmony_ci		 * vsyscall page is readable.
49162306a36Sopenharmony_ci		 */
49262306a36Sopenharmony_ci		printf("[%s]\tprocess_vm_readv() failed (ret = %d, errno = %d)\n", vsyscall_map_r ? "FAIL" : "OK", ret, errno);
49362306a36Sopenharmony_ci		return vsyscall_map_r ? 1 : 0;
49462306a36Sopenharmony_ci	}
49562306a36Sopenharmony_ci
49662306a36Sopenharmony_ci	if (vsyscall_map_r) {
49762306a36Sopenharmony_ci		if (!memcmp(buf, remote.iov_base, sizeof(buf))) {
49862306a36Sopenharmony_ci			printf("[OK]\tIt worked and read correct data\n");
49962306a36Sopenharmony_ci		} else {
50062306a36Sopenharmony_ci			printf("[FAIL]\tIt worked but returned incorrect data\n");
50162306a36Sopenharmony_ci			return 1;
50262306a36Sopenharmony_ci		}
50362306a36Sopenharmony_ci	} else {
50462306a36Sopenharmony_ci		printf("[FAIL]\tprocess_rm_readv() succeeded, but it should have failed in this configuration\n");
50562306a36Sopenharmony_ci		return 1;
50662306a36Sopenharmony_ci	}
50762306a36Sopenharmony_ci#endif
50862306a36Sopenharmony_ci
50962306a36Sopenharmony_ci	return 0;
51062306a36Sopenharmony_ci}
51162306a36Sopenharmony_ci
51262306a36Sopenharmony_ci#ifdef __x86_64__
51362306a36Sopenharmony_cistatic volatile sig_atomic_t num_vsyscall_traps;
51462306a36Sopenharmony_ci
51562306a36Sopenharmony_cistatic void sigtrap(int sig, siginfo_t *info, void *ctx_void)
51662306a36Sopenharmony_ci{
51762306a36Sopenharmony_ci	ucontext_t *ctx = (ucontext_t *)ctx_void;
51862306a36Sopenharmony_ci	unsigned long ip = ctx->uc_mcontext.gregs[REG_RIP];
51962306a36Sopenharmony_ci
52062306a36Sopenharmony_ci	if (((ip ^ 0xffffffffff600000UL) & ~0xfffUL) == 0)
52162306a36Sopenharmony_ci		num_vsyscall_traps++;
52262306a36Sopenharmony_ci}
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_cistatic int test_emulation(void)
52562306a36Sopenharmony_ci{
52662306a36Sopenharmony_ci	time_t tmp;
52762306a36Sopenharmony_ci	bool is_native;
52862306a36Sopenharmony_ci
52962306a36Sopenharmony_ci	if (!vsyscall_map_x)
53062306a36Sopenharmony_ci		return 0;
53162306a36Sopenharmony_ci
53262306a36Sopenharmony_ci	printf("[RUN]\tchecking that vsyscalls are emulated\n");
53362306a36Sopenharmony_ci	sethandler(SIGTRAP, sigtrap, 0);
53462306a36Sopenharmony_ci	set_eflags(get_eflags() | X86_EFLAGS_TF);
53562306a36Sopenharmony_ci	vtime(&tmp);
53662306a36Sopenharmony_ci	set_eflags(get_eflags() & ~X86_EFLAGS_TF);
53762306a36Sopenharmony_ci
53862306a36Sopenharmony_ci	/*
53962306a36Sopenharmony_ci	 * If vsyscalls are emulated, we expect a single trap in the
54062306a36Sopenharmony_ci	 * vsyscall page -- the call instruction will trap with RIP
54162306a36Sopenharmony_ci	 * pointing to the entry point before emulation takes over.
54262306a36Sopenharmony_ci	 * In native mode, we expect two traps, since whatever code
54362306a36Sopenharmony_ci	 * the vsyscall page contains will be more than just a ret
54462306a36Sopenharmony_ci	 * instruction.
54562306a36Sopenharmony_ci	 */
54662306a36Sopenharmony_ci	is_native = (num_vsyscall_traps > 1);
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci	printf("[%s]\tvsyscalls are %s (%d instructions in vsyscall page)\n",
54962306a36Sopenharmony_ci	       (is_native ? "FAIL" : "OK"),
55062306a36Sopenharmony_ci	       (is_native ? "native" : "emulated"),
55162306a36Sopenharmony_ci	       (int)num_vsyscall_traps);
55262306a36Sopenharmony_ci
55362306a36Sopenharmony_ci	return is_native;
55462306a36Sopenharmony_ci}
55562306a36Sopenharmony_ci#endif
55662306a36Sopenharmony_ci
55762306a36Sopenharmony_ciint main(int argc, char **argv)
55862306a36Sopenharmony_ci{
55962306a36Sopenharmony_ci	int nerrs = 0;
56062306a36Sopenharmony_ci
56162306a36Sopenharmony_ci	init_vdso();
56262306a36Sopenharmony_ci	nerrs += init_vsys();
56362306a36Sopenharmony_ci
56462306a36Sopenharmony_ci	nerrs += test_gtod();
56562306a36Sopenharmony_ci	nerrs += test_time();
56662306a36Sopenharmony_ci	nerrs += test_getcpu(0);
56762306a36Sopenharmony_ci	nerrs += test_getcpu(1);
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci	sethandler(SIGSEGV, sigsegv, 0);
57062306a36Sopenharmony_ci	nerrs += test_vsys_r();
57162306a36Sopenharmony_ci	nerrs += test_vsys_x();
57262306a36Sopenharmony_ci
57362306a36Sopenharmony_ci	nerrs += test_process_vm_readv();
57462306a36Sopenharmony_ci
57562306a36Sopenharmony_ci#ifdef __x86_64__
57662306a36Sopenharmony_ci	nerrs += test_emulation();
57762306a36Sopenharmony_ci#endif
57862306a36Sopenharmony_ci
57962306a36Sopenharmony_ci	return nerrs ? 1 : 0;
58062306a36Sopenharmony_ci}
581