0001
0002
0003
0004
0005
0006
0007 #include <stdio.h>
0008 #include <stdlib.h>
0009 #include <unistd.h>
0010 #include <errno.h>
0011 #include <signal.h>
0012 #include <fcntl.h>
0013 #include <sys/mman.h>
0014 #include <sys/ptrace.h>
0015 #include <sys/wait.h>
0016 #include <asm/unistd.h>
0017 #include <init.h>
0018 #include <longjmp.h>
0019 #include <os.h>
0020
0021 #define ARBITRARY_ADDR -1
0022 #define FAILURE_PID -1
0023
0024 #define STAT_PATH_LEN sizeof("/proc/#######/stat\0")
0025 #define COMM_SCANF "%*[^)])"
0026
0027 unsigned long os_process_pc(int pid)
0028 {
0029 char proc_stat[STAT_PATH_LEN], buf[256];
0030 unsigned long pc = ARBITRARY_ADDR;
0031 int fd, err;
0032
0033 sprintf(proc_stat, "/proc/%d/stat", pid);
0034 fd = open(proc_stat, O_RDONLY, 0);
0035 if (fd < 0) {
0036 printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', "
0037 "errno = %d\n", proc_stat, errno);
0038 goto out;
0039 }
0040 CATCH_EINTR(err = read(fd, buf, sizeof(buf)));
0041 if (err < 0) {
0042 printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', "
0043 "err = %d\n", proc_stat, errno);
0044 goto out_close;
0045 }
0046 os_close_file(fd);
0047 pc = ARBITRARY_ADDR;
0048 if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d "
0049 "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d "
0050 "%*d %*d %*d %*d %*d %lu", &pc) != 1)
0051 printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n",
0052 buf);
0053 out_close:
0054 close(fd);
0055 out:
0056 return pc;
0057 }
0058
0059 int os_process_parent(int pid)
0060 {
0061 char stat[STAT_PATH_LEN];
0062 char data[256];
0063 int parent = FAILURE_PID, n, fd;
0064
0065 if (pid == -1)
0066 return parent;
0067
0068 snprintf(stat, sizeof(stat), "/proc/%d/stat", pid);
0069 fd = open(stat, O_RDONLY, 0);
0070 if (fd < 0) {
0071 printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat,
0072 errno);
0073 return parent;
0074 }
0075
0076 CATCH_EINTR(n = read(fd, data, sizeof(data)));
0077 close(fd);
0078
0079 if (n < 0) {
0080 printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat,
0081 errno);
0082 return parent;
0083 }
0084
0085 parent = FAILURE_PID;
0086 n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent);
0087 if (n != 1)
0088 printk(UM_KERN_ERR "Failed to scan '%s'\n", data);
0089
0090 return parent;
0091 }
0092
0093 void os_alarm_process(int pid)
0094 {
0095 kill(pid, SIGALRM);
0096 }
0097
0098 void os_stop_process(int pid)
0099 {
0100 kill(pid, SIGSTOP);
0101 }
0102
0103 void os_kill_process(int pid, int reap_child)
0104 {
0105 kill(pid, SIGKILL);
0106 if (reap_child)
0107 CATCH_EINTR(waitpid(pid, NULL, __WALL));
0108 }
0109
0110
0111
0112
0113
0114
0115 void os_kill_ptraced_process(int pid, int reap_child)
0116 {
0117 kill(pid, SIGKILL);
0118 ptrace(PTRACE_KILL, pid);
0119 ptrace(PTRACE_CONT, pid);
0120 if (reap_child)
0121 CATCH_EINTR(waitpid(pid, NULL, __WALL));
0122 }
0123
0124
0125
0126
0127
0128 int os_getpid(void)
0129 {
0130 return syscall(__NR_getpid);
0131 }
0132
0133 int os_getpgrp(void)
0134 {
0135 return getpgrp();
0136 }
0137
0138 int os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len,
0139 int r, int w, int x)
0140 {
0141 void *loc;
0142 int prot;
0143
0144 prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
0145 (x ? PROT_EXEC : 0);
0146
0147 loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED,
0148 fd, off);
0149 if (loc == MAP_FAILED)
0150 return -errno;
0151 return 0;
0152 }
0153
0154 int os_protect_memory(void *addr, unsigned long len, int r, int w, int x)
0155 {
0156 int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
0157 (x ? PROT_EXEC : 0));
0158
0159 if (mprotect(addr, len, prot) < 0)
0160 return -errno;
0161
0162 return 0;
0163 }
0164
0165 int os_unmap_memory(void *addr, int len)
0166 {
0167 int err;
0168
0169 err = munmap(addr, len);
0170 if (err < 0)
0171 return -errno;
0172 return 0;
0173 }
0174
0175 #ifndef MADV_REMOVE
0176 #define MADV_REMOVE KERNEL_MADV_REMOVE
0177 #endif
0178
0179 int os_drop_memory(void *addr, int length)
0180 {
0181 int err;
0182
0183 err = madvise(addr, length, MADV_REMOVE);
0184 if (err < 0)
0185 err = -errno;
0186 return err;
0187 }
0188
0189 int __init can_drop_memory(void)
0190 {
0191 void *addr;
0192 int fd, ok = 0;
0193
0194 printk(UM_KERN_INFO "Checking host MADV_REMOVE support...");
0195 fd = create_mem_file(UM_KERN_PAGE_SIZE);
0196 if (fd < 0) {
0197 printk(UM_KERN_ERR "Creating test memory file failed, "
0198 "err = %d\n", -fd);
0199 goto out;
0200 }
0201
0202 addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE,
0203 MAP_SHARED, fd, 0);
0204 if (addr == MAP_FAILED) {
0205 printk(UM_KERN_ERR "Mapping test memory file failed, "
0206 "err = %d\n", -errno);
0207 goto out_close;
0208 }
0209
0210 if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) {
0211 printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno);
0212 goto out_unmap;
0213 }
0214
0215 printk(UM_KERN_CONT "OK\n");
0216 ok = 1;
0217
0218 out_unmap:
0219 munmap(addr, UM_KERN_PAGE_SIZE);
0220 out_close:
0221 close(fd);
0222 out:
0223 return ok;
0224 }
0225
0226 static int os_page_mincore(void *addr)
0227 {
0228 char vec[2];
0229 int ret;
0230
0231 ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
0232 if (ret < 0) {
0233 if (errno == ENOMEM || errno == EINVAL)
0234 return 0;
0235 else
0236 return -errno;
0237 }
0238
0239 return vec[0] & 1;
0240 }
0241
0242 int os_mincore(void *addr, unsigned long len)
0243 {
0244 char *vec;
0245 int ret, i;
0246
0247 if (len <= UM_KERN_PAGE_SIZE)
0248 return os_page_mincore(addr);
0249
0250 vec = calloc(1, (len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE);
0251 if (!vec)
0252 return -ENOMEM;
0253
0254 ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
0255 if (ret < 0) {
0256 if (errno == ENOMEM || errno == EINVAL)
0257 ret = 0;
0258 else
0259 ret = -errno;
0260
0261 goto out;
0262 }
0263
0264 for (i = 0; i < ((len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE); i++) {
0265 if (!(vec[i] & 1)) {
0266 ret = 0;
0267 goto out;
0268 }
0269 }
0270
0271 ret = 1;
0272 out:
0273 free(vec);
0274 return ret;
0275 }
0276
0277 void init_new_thread_signals(void)
0278 {
0279 set_handler(SIGSEGV);
0280 set_handler(SIGTRAP);
0281 set_handler(SIGFPE);
0282 set_handler(SIGILL);
0283 set_handler(SIGBUS);
0284 signal(SIGHUP, SIG_IGN);
0285 set_handler(SIGIO);
0286 signal(SIGWINCH, SIG_IGN);
0287 }