Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) #define _GNU_SOURCE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3) #include <stdio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) #include <signal.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) #include <unistd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) #include <errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <sys/wait.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <sys/syscall.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <sys/user.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <sys/mman.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include "linux/ptrace.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) static int sys_rt_sigqueueinfo(pid_t tgid, int sig, siginfo_t *uinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 	return syscall(SYS_rt_sigqueueinfo, tgid, sig, uinfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) static int sys_rt_tgsigqueueinfo(pid_t tgid, pid_t tid,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 					int sig, siginfo_t *uinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 	return syscall(SYS_rt_tgsigqueueinfo, tgid, tid, sig, uinfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) static int sys_ptrace(int request, pid_t pid, void *addr, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	return syscall(SYS_ptrace, request, pid, addr, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define SIGNR 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #define TEST_SICODE_PRIV	-1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define TEST_SICODE_SHARE	-2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #ifndef PAGE_SIZE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #define PAGE_SIZE sysconf(_SC_PAGESIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) #define err(fmt, ...)						\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 		fprintf(stderr,					\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 			"Error (%s:%d): " fmt,			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 			__FILE__, __LINE__, ##__VA_ARGS__)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) static int check_error_paths(pid_t child)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct ptrace_peeksiginfo_args arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	int ret, exit_code = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	void *addr_rw, *addr_ro;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	 * Allocate two contiguous pages. The first one is for read-write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	 * another is for read-only.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	addr_rw = mmap(NULL, 2 * PAGE_SIZE, PROT_READ | PROT_WRITE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 				MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	if (addr_rw == MAP_FAILED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 		err("mmap() failed: %m\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	addr_ro = mmap(addr_rw + PAGE_SIZE, PAGE_SIZE, PROT_READ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 			MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED, -1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	if (addr_ro == MAP_FAILED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 		err("mmap() failed: %m\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	arg.nr = SIGNR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	arg.off = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	/* Unsupported flags */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	arg.flags = ~0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	ret = sys_ptrace(PTRACE_PEEKSIGINFO, child, &arg, addr_rw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	if (ret != -1 || errno != EINVAL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		err("sys_ptrace() returns %d (expected -1),"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 				" errno %d (expected %d): %m\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 				ret, errno, EINVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	arg.flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	/* A part of the buffer is read-only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	ret = sys_ptrace(PTRACE_PEEKSIGINFO, child, &arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 					addr_ro - sizeof(siginfo_t) * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	if (ret != 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		err("sys_ptrace() returns %d (expected 2): %m\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	/* Read-only buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	ret = sys_ptrace(PTRACE_PEEKSIGINFO, child, &arg, addr_ro);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	if (ret != -1 && errno != EFAULT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		err("sys_ptrace() returns %d (expected -1),"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 				" errno %d (expected %d): %m\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 				ret, errno, EFAULT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	exit_code = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	munmap(addr_rw, 2 * PAGE_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	return exit_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) int check_direct_path(pid_t child, int shared, int nr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	struct ptrace_peeksiginfo_args arg = {.flags = 0, .nr = nr, .off = 0};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	int i, j, ret, exit_code = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	siginfo_t siginfo[SIGNR];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	int si_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	if (shared == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		arg.flags = PTRACE_PEEKSIGINFO_SHARED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		si_code = TEST_SICODE_SHARE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 		arg.flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		si_code = TEST_SICODE_PRIV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	for (i = 0; i < SIGNR; ) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		arg.off = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		ret = sys_ptrace(PTRACE_PEEKSIGINFO, child, &arg, siginfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		if (ret == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 			err("ptrace() failed: %m\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 			goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		if (ret == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		for (j = 0; j < ret; j++, i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 			if (siginfo[j].si_code == si_code &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 			    siginfo[j].si_int == i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 				continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 			err("%d: Wrong siginfo i=%d si_code=%d si_int=%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 			     shared, i, siginfo[j].si_code, siginfo[j].si_int);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 			goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	if (i != SIGNR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 		err("Only %d signals were read\n", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	exit_code = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	return exit_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) int main(int argc, char *argv[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	siginfo_t siginfo[SIGNR];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	int i, exit_code = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	sigset_t blockmask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	pid_t child;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	sigemptyset(&blockmask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	sigaddset(&blockmask, SIGRTMIN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	sigprocmask(SIG_BLOCK, &blockmask, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	child = fork();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	if (child == -1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		err("fork() failed: %m");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	} else if (child == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 		pid_t ppid = getppid();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 		while (1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 			if (ppid != getppid())
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 			sleep(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	/* Send signals in process-wide and per-thread queues */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	for (i = 0; i < SIGNR; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 		siginfo->si_code = TEST_SICODE_SHARE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		siginfo->si_int = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		sys_rt_sigqueueinfo(child, SIGRTMIN, siginfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		siginfo->si_code = TEST_SICODE_PRIV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		siginfo->si_int = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		sys_rt_tgsigqueueinfo(child, child, SIGRTMIN, siginfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	if (sys_ptrace(PTRACE_ATTACH, child, NULL, NULL) == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	waitpid(child, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	/* Dump signals one by one*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	if (check_direct_path(child, 0, 1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	/* Dump all signals for one call */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	if (check_direct_path(child, 0, SIGNR))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	 * Dump signal from the process-wide queue.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	 * The number of signals is not multible to the buffer size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	if (check_direct_path(child, 1, 3))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	if (check_error_paths(child))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	printf("PASS\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	exit_code = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	if (sys_ptrace(PTRACE_KILL, child, NULL, NULL) == -1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	waitpid(child, NULL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	return exit_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) }