|  | /* | 
|  | * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) | 
|  | * Licensed under the GPL | 
|  | */ | 
|  |  | 
|  | #include <stdio.h> | 
|  | #include <unistd.h> | 
|  | #include <errno.h> | 
|  | #include <signal.h> | 
|  | #include <fcntl.h> | 
|  | #include <sys/mman.h> | 
|  | #include <sys/ptrace.h> | 
|  | #include <sys/wait.h> | 
|  | #include <asm/unistd.h> | 
|  | #include <init.h> | 
|  | #include <longjmp.h> | 
|  | #include <os.h> | 
|  | #include <skas_ptrace.h> | 
|  |  | 
|  | #define ARBITRARY_ADDR -1 | 
|  | #define FAILURE_PID    -1 | 
|  |  | 
|  | #define STAT_PATH_LEN sizeof("/proc/#######/stat\0") | 
|  | #define COMM_SCANF "%*[^)])" | 
|  |  | 
|  | unsigned long os_process_pc(int pid) | 
|  | { | 
|  | char proc_stat[STAT_PATH_LEN], buf[256]; | 
|  | unsigned long pc = ARBITRARY_ADDR; | 
|  | int fd, err; | 
|  |  | 
|  | sprintf(proc_stat, "/proc/%d/stat", pid); | 
|  | fd = open(proc_stat, O_RDONLY, 0); | 
|  | if (fd < 0) { | 
|  | printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', " | 
|  | "errno = %d\n", proc_stat, errno); | 
|  | goto out; | 
|  | } | 
|  | CATCH_EINTR(err = read(fd, buf, sizeof(buf))); | 
|  | if (err < 0) { | 
|  | printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', " | 
|  | "err = %d\n", proc_stat, errno); | 
|  | goto out_close; | 
|  | } | 
|  | os_close_file(fd); | 
|  | pc = ARBITRARY_ADDR; | 
|  | if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d " | 
|  | "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d " | 
|  | "%*d %*d %*d %*d %*d %lu", &pc) != 1) | 
|  | printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n", | 
|  | buf); | 
|  | out_close: | 
|  | close(fd); | 
|  | out: | 
|  | return pc; | 
|  | } | 
|  |  | 
|  | int os_process_parent(int pid) | 
|  | { | 
|  | char stat[STAT_PATH_LEN]; | 
|  | char data[256]; | 
|  | int parent = FAILURE_PID, n, fd; | 
|  |  | 
|  | if (pid == -1) | 
|  | return parent; | 
|  |  | 
|  | snprintf(stat, sizeof(stat), "/proc/%d/stat", pid); | 
|  | fd = open(stat, O_RDONLY, 0); | 
|  | if (fd < 0) { | 
|  | printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat, | 
|  | errno); | 
|  | return parent; | 
|  | } | 
|  |  | 
|  | CATCH_EINTR(n = read(fd, data, sizeof(data))); | 
|  | close(fd); | 
|  |  | 
|  | if (n < 0) { | 
|  | printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat, | 
|  | errno); | 
|  | return parent; | 
|  | } | 
|  |  | 
|  | parent = FAILURE_PID; | 
|  | n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent); | 
|  | if (n != 1) | 
|  | printk(UM_KERN_ERR "Failed to scan '%s'\n", data); | 
|  |  | 
|  | return parent; | 
|  | } | 
|  |  | 
|  | void os_stop_process(int pid) | 
|  | { | 
|  | kill(pid, SIGSTOP); | 
|  | } | 
|  |  | 
|  | void os_kill_process(int pid, int reap_child) | 
|  | { | 
|  | kill(pid, SIGKILL); | 
|  | if (reap_child) | 
|  | CATCH_EINTR(waitpid(pid, NULL, __WALL)); | 
|  | } | 
|  |  | 
|  | /* This is here uniquely to have access to the userspace errno, i.e. the one | 
|  | * used by ptrace in case of error. | 
|  | */ | 
|  |  | 
|  | long os_ptrace_ldt(long pid, long addr, long data) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = ptrace(PTRACE_LDT, pid, addr, data); | 
|  |  | 
|  | if (ret < 0) | 
|  | return -errno; | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* Kill off a ptraced child by all means available.  kill it normally first, | 
|  | * then PTRACE_KILL it, then PTRACE_CONT it in case it's in a run state from | 
|  | * which it can't exit directly. | 
|  | */ | 
|  |  | 
|  | void os_kill_ptraced_process(int pid, int reap_child) | 
|  | { | 
|  | kill(pid, SIGKILL); | 
|  | ptrace(PTRACE_KILL, pid); | 
|  | ptrace(PTRACE_CONT, pid); | 
|  | if (reap_child) | 
|  | CATCH_EINTR(waitpid(pid, NULL, __WALL)); | 
|  | } | 
|  |  | 
|  | /* Don't use the glibc version, which caches the result in TLS. It misses some | 
|  | * syscalls, and also breaks with clone(), which does not unshare the TLS. | 
|  | */ | 
|  |  | 
|  | int os_getpid(void) | 
|  | { | 
|  | return syscall(__NR_getpid); | 
|  | } | 
|  |  | 
|  | int os_getpgrp(void) | 
|  | { | 
|  | return getpgrp(); | 
|  | } | 
|  |  | 
|  | int os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len, | 
|  | int r, int w, int x) | 
|  | { | 
|  | void *loc; | 
|  | int prot; | 
|  |  | 
|  | prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) | | 
|  | (x ? PROT_EXEC : 0); | 
|  |  | 
|  | loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED, | 
|  | fd, off); | 
|  | if (loc == MAP_FAILED) | 
|  | return -errno; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int os_protect_memory(void *addr, unsigned long len, int r, int w, int x) | 
|  | { | 
|  | int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) | | 
|  | (x ? PROT_EXEC : 0)); | 
|  |  | 
|  | if (mprotect(addr, len, prot) < 0) | 
|  | return -errno; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int os_unmap_memory(void *addr, int len) | 
|  | { | 
|  | int err; | 
|  |  | 
|  | err = munmap(addr, len); | 
|  | if (err < 0) | 
|  | return -errno; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #ifndef MADV_REMOVE | 
|  | #define MADV_REMOVE KERNEL_MADV_REMOVE | 
|  | #endif | 
|  |  | 
|  | int os_drop_memory(void *addr, int length) | 
|  | { | 
|  | int err; | 
|  |  | 
|  | err = madvise(addr, length, MADV_REMOVE); | 
|  | if (err < 0) | 
|  | err = -errno; | 
|  | return err; | 
|  | } | 
|  |  | 
|  | int __init can_drop_memory(void) | 
|  | { | 
|  | void *addr; | 
|  | int fd, ok = 0; | 
|  |  | 
|  | printk(UM_KERN_INFO "Checking host MADV_REMOVE support..."); | 
|  | fd = create_mem_file(UM_KERN_PAGE_SIZE); | 
|  | if (fd < 0) { | 
|  | printk(UM_KERN_ERR "Creating test memory file failed, " | 
|  | "err = %d\n", -fd); | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE, | 
|  | MAP_SHARED, fd, 0); | 
|  | if (addr == MAP_FAILED) { | 
|  | printk(UM_KERN_ERR "Mapping test memory file failed, " | 
|  | "err = %d\n", -errno); | 
|  | goto out_close; | 
|  | } | 
|  |  | 
|  | if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) { | 
|  | printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno); | 
|  | goto out_unmap; | 
|  | } | 
|  |  | 
|  | printk(UM_KERN_CONT "OK\n"); | 
|  | ok = 1; | 
|  |  | 
|  | out_unmap: | 
|  | munmap(addr, UM_KERN_PAGE_SIZE); | 
|  | out_close: | 
|  | close(fd); | 
|  | out: | 
|  | return ok; | 
|  | } | 
|  |  | 
|  | void init_new_thread_signals(void) | 
|  | { | 
|  | set_handler(SIGSEGV); | 
|  | set_handler(SIGTRAP); | 
|  | set_handler(SIGFPE); | 
|  | set_handler(SIGILL); | 
|  | set_handler(SIGBUS); | 
|  | signal(SIGHUP, SIG_IGN); | 
|  | set_handler(SIGIO); | 
|  | signal(SIGWINCH, SIG_IGN); | 
|  | signal(SIGTERM, SIG_DFL); | 
|  | } |