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