18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2015 Thomas Meyer (thomas@m3y3r.de)
48c2ecf20Sopenharmony_ci * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
58c2ecf20Sopenharmony_ci */
68c2ecf20Sopenharmony_ci
78c2ecf20Sopenharmony_ci#include <stdio.h>
88c2ecf20Sopenharmony_ci#include <stdlib.h>
98c2ecf20Sopenharmony_ci#include <unistd.h>
108c2ecf20Sopenharmony_ci#include <errno.h>
118c2ecf20Sopenharmony_ci#include <signal.h>
128c2ecf20Sopenharmony_ci#include <fcntl.h>
138c2ecf20Sopenharmony_ci#include <sys/mman.h>
148c2ecf20Sopenharmony_ci#include <sys/ptrace.h>
158c2ecf20Sopenharmony_ci#include <sys/wait.h>
168c2ecf20Sopenharmony_ci#include <asm/unistd.h>
178c2ecf20Sopenharmony_ci#include <init.h>
188c2ecf20Sopenharmony_ci#include <longjmp.h>
198c2ecf20Sopenharmony_ci#include <os.h>
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ci#define ARBITRARY_ADDR -1
228c2ecf20Sopenharmony_ci#define FAILURE_PID    -1
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_ci#define STAT_PATH_LEN sizeof("/proc/#######/stat\0")
258c2ecf20Sopenharmony_ci#define COMM_SCANF "%*[^)])"
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ciunsigned long os_process_pc(int pid)
288c2ecf20Sopenharmony_ci{
298c2ecf20Sopenharmony_ci	char proc_stat[STAT_PATH_LEN], buf[256];
308c2ecf20Sopenharmony_ci	unsigned long pc = ARBITRARY_ADDR;
318c2ecf20Sopenharmony_ci	int fd, err;
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci	sprintf(proc_stat, "/proc/%d/stat", pid);
348c2ecf20Sopenharmony_ci	fd = open(proc_stat, O_RDONLY, 0);
358c2ecf20Sopenharmony_ci	if (fd < 0) {
368c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', "
378c2ecf20Sopenharmony_ci		       "errno = %d\n", proc_stat, errno);
388c2ecf20Sopenharmony_ci		goto out;
398c2ecf20Sopenharmony_ci	}
408c2ecf20Sopenharmony_ci	CATCH_EINTR(err = read(fd, buf, sizeof(buf)));
418c2ecf20Sopenharmony_ci	if (err < 0) {
428c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', "
438c2ecf20Sopenharmony_ci		       "err = %d\n", proc_stat, errno);
448c2ecf20Sopenharmony_ci		goto out_close;
458c2ecf20Sopenharmony_ci	}
468c2ecf20Sopenharmony_ci	os_close_file(fd);
478c2ecf20Sopenharmony_ci	pc = ARBITRARY_ADDR;
488c2ecf20Sopenharmony_ci	if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d "
498c2ecf20Sopenharmony_ci		   "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d "
508c2ecf20Sopenharmony_ci		   "%*d %*d %*d %*d %*d %lu", &pc) != 1)
518c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n",
528c2ecf20Sopenharmony_ci		       buf);
538c2ecf20Sopenharmony_ci out_close:
548c2ecf20Sopenharmony_ci	close(fd);
558c2ecf20Sopenharmony_ci out:
568c2ecf20Sopenharmony_ci	return pc;
578c2ecf20Sopenharmony_ci}
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ciint os_process_parent(int pid)
608c2ecf20Sopenharmony_ci{
618c2ecf20Sopenharmony_ci	char stat[STAT_PATH_LEN];
628c2ecf20Sopenharmony_ci	char data[256];
638c2ecf20Sopenharmony_ci	int parent = FAILURE_PID, n, fd;
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_ci	if (pid == -1)
668c2ecf20Sopenharmony_ci		return parent;
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_ci	snprintf(stat, sizeof(stat), "/proc/%d/stat", pid);
698c2ecf20Sopenharmony_ci	fd = open(stat, O_RDONLY, 0);
708c2ecf20Sopenharmony_ci	if (fd < 0) {
718c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat,
728c2ecf20Sopenharmony_ci		       errno);
738c2ecf20Sopenharmony_ci		return parent;
748c2ecf20Sopenharmony_ci	}
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci	CATCH_EINTR(n = read(fd, data, sizeof(data)));
778c2ecf20Sopenharmony_ci	close(fd);
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_ci	if (n < 0) {
808c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat,
818c2ecf20Sopenharmony_ci		       errno);
828c2ecf20Sopenharmony_ci		return parent;
838c2ecf20Sopenharmony_ci	}
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ci	parent = FAILURE_PID;
868c2ecf20Sopenharmony_ci	n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent);
878c2ecf20Sopenharmony_ci	if (n != 1)
888c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Failed to scan '%s'\n", data);
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_ci	return parent;
918c2ecf20Sopenharmony_ci}
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_civoid os_alarm_process(int pid)
948c2ecf20Sopenharmony_ci{
958c2ecf20Sopenharmony_ci	kill(pid, SIGALRM);
968c2ecf20Sopenharmony_ci}
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_civoid os_stop_process(int pid)
998c2ecf20Sopenharmony_ci{
1008c2ecf20Sopenharmony_ci	kill(pid, SIGSTOP);
1018c2ecf20Sopenharmony_ci}
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_civoid os_kill_process(int pid, int reap_child)
1048c2ecf20Sopenharmony_ci{
1058c2ecf20Sopenharmony_ci	kill(pid, SIGKILL);
1068c2ecf20Sopenharmony_ci	if (reap_child)
1078c2ecf20Sopenharmony_ci		CATCH_EINTR(waitpid(pid, NULL, __WALL));
1088c2ecf20Sopenharmony_ci}
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci/* Kill off a ptraced child by all means available.  kill it normally first,
1118c2ecf20Sopenharmony_ci * then PTRACE_KILL it, then PTRACE_CONT it in case it's in a run state from
1128c2ecf20Sopenharmony_ci * which it can't exit directly.
1138c2ecf20Sopenharmony_ci */
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_civoid os_kill_ptraced_process(int pid, int reap_child)
1168c2ecf20Sopenharmony_ci{
1178c2ecf20Sopenharmony_ci	kill(pid, SIGKILL);
1188c2ecf20Sopenharmony_ci	ptrace(PTRACE_KILL, pid);
1198c2ecf20Sopenharmony_ci	ptrace(PTRACE_CONT, pid);
1208c2ecf20Sopenharmony_ci	if (reap_child)
1218c2ecf20Sopenharmony_ci		CATCH_EINTR(waitpid(pid, NULL, __WALL));
1228c2ecf20Sopenharmony_ci}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci/* Don't use the glibc version, which caches the result in TLS. It misses some
1258c2ecf20Sopenharmony_ci * syscalls, and also breaks with clone(), which does not unshare the TLS.
1268c2ecf20Sopenharmony_ci */
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ciint os_getpid(void)
1298c2ecf20Sopenharmony_ci{
1308c2ecf20Sopenharmony_ci	return syscall(__NR_getpid);
1318c2ecf20Sopenharmony_ci}
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ciint os_getpgrp(void)
1348c2ecf20Sopenharmony_ci{
1358c2ecf20Sopenharmony_ci	return getpgrp();
1368c2ecf20Sopenharmony_ci}
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ciint os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len,
1398c2ecf20Sopenharmony_ci		  int r, int w, int x)
1408c2ecf20Sopenharmony_ci{
1418c2ecf20Sopenharmony_ci	void *loc;
1428c2ecf20Sopenharmony_ci	int prot;
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci	prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
1458c2ecf20Sopenharmony_ci		(x ? PROT_EXEC : 0);
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci	loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED,
1488c2ecf20Sopenharmony_ci		     fd, off);
1498c2ecf20Sopenharmony_ci	if (loc == MAP_FAILED)
1508c2ecf20Sopenharmony_ci		return -errno;
1518c2ecf20Sopenharmony_ci	return 0;
1528c2ecf20Sopenharmony_ci}
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_ciint os_protect_memory(void *addr, unsigned long len, int r, int w, int x)
1558c2ecf20Sopenharmony_ci{
1568c2ecf20Sopenharmony_ci	int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
1578c2ecf20Sopenharmony_ci		    (x ? PROT_EXEC : 0));
1588c2ecf20Sopenharmony_ci
1598c2ecf20Sopenharmony_ci	if (mprotect(addr, len, prot) < 0)
1608c2ecf20Sopenharmony_ci		return -errno;
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ci	return 0;
1638c2ecf20Sopenharmony_ci}
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ciint os_unmap_memory(void *addr, int len)
1668c2ecf20Sopenharmony_ci{
1678c2ecf20Sopenharmony_ci	int err;
1688c2ecf20Sopenharmony_ci
1698c2ecf20Sopenharmony_ci	err = munmap(addr, len);
1708c2ecf20Sopenharmony_ci	if (err < 0)
1718c2ecf20Sopenharmony_ci		return -errno;
1728c2ecf20Sopenharmony_ci	return 0;
1738c2ecf20Sopenharmony_ci}
1748c2ecf20Sopenharmony_ci
1758c2ecf20Sopenharmony_ci#ifndef MADV_REMOVE
1768c2ecf20Sopenharmony_ci#define MADV_REMOVE KERNEL_MADV_REMOVE
1778c2ecf20Sopenharmony_ci#endif
1788c2ecf20Sopenharmony_ci
1798c2ecf20Sopenharmony_ciint os_drop_memory(void *addr, int length)
1808c2ecf20Sopenharmony_ci{
1818c2ecf20Sopenharmony_ci	int err;
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_ci	err = madvise(addr, length, MADV_REMOVE);
1848c2ecf20Sopenharmony_ci	if (err < 0)
1858c2ecf20Sopenharmony_ci		err = -errno;
1868c2ecf20Sopenharmony_ci	return err;
1878c2ecf20Sopenharmony_ci}
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_ciint __init can_drop_memory(void)
1908c2ecf20Sopenharmony_ci{
1918c2ecf20Sopenharmony_ci	void *addr;
1928c2ecf20Sopenharmony_ci	int fd, ok = 0;
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci	printk(UM_KERN_INFO "Checking host MADV_REMOVE support...");
1958c2ecf20Sopenharmony_ci	fd = create_mem_file(UM_KERN_PAGE_SIZE);
1968c2ecf20Sopenharmony_ci	if (fd < 0) {
1978c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Creating test memory file failed, "
1988c2ecf20Sopenharmony_ci		       "err = %d\n", -fd);
1998c2ecf20Sopenharmony_ci		goto out;
2008c2ecf20Sopenharmony_ci	}
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci	addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE,
2038c2ecf20Sopenharmony_ci		      MAP_SHARED, fd, 0);
2048c2ecf20Sopenharmony_ci	if (addr == MAP_FAILED) {
2058c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "Mapping test memory file failed, "
2068c2ecf20Sopenharmony_ci		       "err = %d\n", -errno);
2078c2ecf20Sopenharmony_ci		goto out_close;
2088c2ecf20Sopenharmony_ci	}
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_ci	if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) {
2118c2ecf20Sopenharmony_ci		printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno);
2128c2ecf20Sopenharmony_ci		goto out_unmap;
2138c2ecf20Sopenharmony_ci	}
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_ci	printk(UM_KERN_CONT "OK\n");
2168c2ecf20Sopenharmony_ci	ok = 1;
2178c2ecf20Sopenharmony_ci
2188c2ecf20Sopenharmony_ciout_unmap:
2198c2ecf20Sopenharmony_ci	munmap(addr, UM_KERN_PAGE_SIZE);
2208c2ecf20Sopenharmony_ciout_close:
2218c2ecf20Sopenharmony_ci	close(fd);
2228c2ecf20Sopenharmony_ciout:
2238c2ecf20Sopenharmony_ci	return ok;
2248c2ecf20Sopenharmony_ci}
2258c2ecf20Sopenharmony_ci
2268c2ecf20Sopenharmony_cistatic int os_page_mincore(void *addr)
2278c2ecf20Sopenharmony_ci{
2288c2ecf20Sopenharmony_ci	char vec[2];
2298c2ecf20Sopenharmony_ci	int ret;
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
2328c2ecf20Sopenharmony_ci	if (ret < 0) {
2338c2ecf20Sopenharmony_ci		if (errno == ENOMEM || errno == EINVAL)
2348c2ecf20Sopenharmony_ci			return 0;
2358c2ecf20Sopenharmony_ci		else
2368c2ecf20Sopenharmony_ci			return -errno;
2378c2ecf20Sopenharmony_ci	}
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_ci	return vec[0] & 1;
2408c2ecf20Sopenharmony_ci}
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ciint os_mincore(void *addr, unsigned long len)
2438c2ecf20Sopenharmony_ci{
2448c2ecf20Sopenharmony_ci	char *vec;
2458c2ecf20Sopenharmony_ci	int ret, i;
2468c2ecf20Sopenharmony_ci
2478c2ecf20Sopenharmony_ci	if (len <= UM_KERN_PAGE_SIZE)
2488c2ecf20Sopenharmony_ci		return os_page_mincore(addr);
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_ci	vec = calloc(1, (len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE);
2518c2ecf20Sopenharmony_ci	if (!vec)
2528c2ecf20Sopenharmony_ci		return -ENOMEM;
2538c2ecf20Sopenharmony_ci
2548c2ecf20Sopenharmony_ci	ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
2558c2ecf20Sopenharmony_ci	if (ret < 0) {
2568c2ecf20Sopenharmony_ci		if (errno == ENOMEM || errno == EINVAL)
2578c2ecf20Sopenharmony_ci			ret = 0;
2588c2ecf20Sopenharmony_ci		else
2598c2ecf20Sopenharmony_ci			ret = -errno;
2608c2ecf20Sopenharmony_ci
2618c2ecf20Sopenharmony_ci		goto out;
2628c2ecf20Sopenharmony_ci	}
2638c2ecf20Sopenharmony_ci
2648c2ecf20Sopenharmony_ci	for (i = 0; i < ((len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE); i++) {
2658c2ecf20Sopenharmony_ci		if (!(vec[i] & 1)) {
2668c2ecf20Sopenharmony_ci			ret = 0;
2678c2ecf20Sopenharmony_ci			goto out;
2688c2ecf20Sopenharmony_ci		}
2698c2ecf20Sopenharmony_ci	}
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_ci	ret = 1;
2728c2ecf20Sopenharmony_ciout:
2738c2ecf20Sopenharmony_ci	free(vec);
2748c2ecf20Sopenharmony_ci	return ret;
2758c2ecf20Sopenharmony_ci}
2768c2ecf20Sopenharmony_ci
2778c2ecf20Sopenharmony_civoid init_new_thread_signals(void)
2788c2ecf20Sopenharmony_ci{
2798c2ecf20Sopenharmony_ci	set_handler(SIGSEGV);
2808c2ecf20Sopenharmony_ci	set_handler(SIGTRAP);
2818c2ecf20Sopenharmony_ci	set_handler(SIGFPE);
2828c2ecf20Sopenharmony_ci	set_handler(SIGILL);
2838c2ecf20Sopenharmony_ci	set_handler(SIGBUS);
2848c2ecf20Sopenharmony_ci	signal(SIGHUP, SIG_IGN);
2858c2ecf20Sopenharmony_ci	set_handler(SIGIO);
2868c2ecf20Sopenharmony_ci	signal(SIGWINCH, SIG_IGN);
2878c2ecf20Sopenharmony_ci}
288