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