blob: 8408aba915b29f7e603233fc5c27e80abd081864 [file] [log] [blame]
Jeff Dikeba180fd2007-10-16 01:27:00 -07001/*
2 * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 * Licensed under the GPL
4 */
5
Linus Torvalds1da177e2005-04-16 15:20:36 -07006#include <stdio.h>
Richard Weinbergerf75b1b12013-08-17 18:46:00 +02007#include <stdlib.h>
Jeff Dikeba180fd2007-10-16 01:27:00 -07008#include <unistd.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <errno.h>
10#include <signal.h>
Jeff Dike512b6fb2007-10-16 01:27:11 -070011#include <fcntl.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <sys/mman.h>
Jeff Dikeba180fd2007-10-16 01:27:00 -070013#include <sys/ptrace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <sys/wait.h>
Jeff Dikeba180fd2007-10-16 01:27:00 -070015#include <asm/unistd.h>
Al Viro37185b32012-10-08 03:27:32 +010016#include <init.h>
17#include <longjmp.h>
18#include <os.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019
20#define ARBITRARY_ADDR -1
21#define FAILURE_PID -1
22
23#define STAT_PATH_LEN sizeof("/proc/#######/stat\0")
24#define COMM_SCANF "%*[^)])"
25
26unsigned long os_process_pc(int pid)
27{
28 char proc_stat[STAT_PATH_LEN], buf[256];
Jeff Dike512b6fb2007-10-16 01:27:11 -070029 unsigned long pc = ARBITRARY_ADDR;
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 int fd, err;
31
32 sprintf(proc_stat, "/proc/%d/stat", pid);
Jeff Dike512b6fb2007-10-16 01:27:11 -070033 fd = open(proc_stat, O_RDONLY, 0);
Jeff Dikeba180fd2007-10-16 01:27:00 -070034 if (fd < 0) {
35 printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', "
Jeff Dike512b6fb2007-10-16 01:27:11 -070036 "errno = %d\n", proc_stat, errno);
37 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -070038 }
Jeff Dikea61f3342007-05-06 14:51:35 -070039 CATCH_EINTR(err = read(fd, buf, sizeof(buf)));
Jeff Dikeba180fd2007-10-16 01:27:00 -070040 if (err < 0) {
41 printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', "
42 "err = %d\n", proc_stat, errno);
Jeff Dike512b6fb2007-10-16 01:27:11 -070043 goto out_close;
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 }
45 os_close_file(fd);
46 pc = ARBITRARY_ADDR;
Jeff Dikeba180fd2007-10-16 01:27:00 -070047 if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d "
Jeff Dike512b6fb2007-10-16 01:27:11 -070048 "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d "
49 "%*d %*d %*d %*d %*d %lu", &pc) != 1)
Jeff Dikeba180fd2007-10-16 01:27:00 -070050 printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n",
51 buf);
Jeff Dike512b6fb2007-10-16 01:27:11 -070052 out_close:
53 close(fd);
54 out:
Jeff Dikeef0470c2007-05-06 14:51:33 -070055 return pc;
Linus Torvalds1da177e2005-04-16 15:20:36 -070056}
57
58int os_process_parent(int pid)
59{
60 char stat[STAT_PATH_LEN];
61 char data[256];
Jeff Dike512b6fb2007-10-16 01:27:11 -070062 int parent = FAILURE_PID, n, fd;
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
Jeff Dikeba180fd2007-10-16 01:27:00 -070064 if (pid == -1)
Jeff Dike512b6fb2007-10-16 01:27:11 -070065 return parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
67 snprintf(stat, sizeof(stat), "/proc/%d/stat", pid);
Jeff Dike512b6fb2007-10-16 01:27:11 -070068 fd = open(stat, O_RDONLY, 0);
Jeff Dikeba180fd2007-10-16 01:27:00 -070069 if (fd < 0) {
Jeff Dike512b6fb2007-10-16 01:27:11 -070070 printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat,
71 errno);
72 return parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -070073 }
74
Jeff Dikea61f3342007-05-06 14:51:35 -070075 CATCH_EINTR(n = read(fd, data, sizeof(data)));
Jeff Dike512b6fb2007-10-16 01:27:11 -070076 close(fd);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
Jeff Dikeba180fd2007-10-16 01:27:00 -070078 if (n < 0) {
Jeff Dike512b6fb2007-10-16 01:27:11 -070079 printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat,
Jeff Dikeba180fd2007-10-16 01:27:00 -070080 errno);
Jeff Dike512b6fb2007-10-16 01:27:11 -070081 return parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 }
83
84 parent = FAILURE_PID;
85 n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent);
Jeff Dikeba180fd2007-10-16 01:27:00 -070086 if (n != 1)
87 printk(UM_KERN_ERR "Failed to scan '%s'\n", data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
Jeff Dikeef0470c2007-05-06 14:51:33 -070089 return parent;
Linus Torvalds1da177e2005-04-16 15:20:36 -070090}
91
92void os_stop_process(int pid)
93{
94 kill(pid, SIGSTOP);
95}
96
97void os_kill_process(int pid, int reap_child)
98{
99 kill(pid, SIGKILL);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700100 if (reap_child)
Stanislaw Gruszka4dbed852007-12-17 16:19:46 -0800101 CATCH_EINTR(waitpid(pid, NULL, __WALL));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102}
103
104/* Kill off a ptraced child by all means available. kill it normally first,
105 * then PTRACE_KILL it, then PTRACE_CONT it in case it's in a run state from
106 * which it can't exit directly.
107 */
108
109void os_kill_ptraced_process(int pid, int reap_child)
110{
111 kill(pid, SIGKILL);
112 ptrace(PTRACE_KILL, pid);
113 ptrace(PTRACE_CONT, pid);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700114 if (reap_child)
Stanislaw Gruszka4dbed852007-12-17 16:19:46 -0800115 CATCH_EINTR(waitpid(pid, NULL, __WALL));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116}
117
Gennady Sharapov60d339f62005-09-03 15:57:47 -0700118/* Don't use the glibc version, which caches the result in TLS. It misses some
119 * syscalls, and also breaks with clone(), which does not unshare the TLS.
120 */
121
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122int os_getpid(void)
123{
Jeff Dikeef0470c2007-05-06 14:51:33 -0700124 return syscall(__NR_getpid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125}
126
Jeff Dikecd2ee4a2005-05-05 16:15:32 -0700127int os_getpgrp(void)
128{
129 return getpgrp();
130}
131
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132int os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len,
133 int r, int w, int x)
134{
135 void *loc;
136 int prot;
137
Jeff Dikeba180fd2007-10-16 01:27:00 -0700138 prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139 (x ? PROT_EXEC : 0);
140
141 loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED,
142 fd, off);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700143 if (loc == MAP_FAILED)
Jeff Dikeef0470c2007-05-06 14:51:33 -0700144 return -errno;
145 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146}
147
148int os_protect_memory(void *addr, unsigned long len, int r, int w, int x)
149{
Jeff Dikeba180fd2007-10-16 01:27:00 -0700150 int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 (x ? PROT_EXEC : 0));
152
Jeff Dikeba180fd2007-10-16 01:27:00 -0700153 if (mprotect(addr, len, prot) < 0)
Jeff Dikeef0470c2007-05-06 14:51:33 -0700154 return -errno;
Jeff Dikeba180fd2007-10-16 01:27:00 -0700155
156 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157}
158
159int os_unmap_memory(void *addr, int len)
160{
Jeff Dikeba180fd2007-10-16 01:27:00 -0700161 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
Jeff Dikeba180fd2007-10-16 01:27:00 -0700163 err = munmap(addr, len);
164 if (err < 0)
Jeff Dikeef0470c2007-05-06 14:51:33 -0700165 return -errno;
Jeff Dikeba180fd2007-10-16 01:27:00 -0700166 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167}
168
Jeff Dike02dea082006-03-31 02:30:08 -0800169#ifndef MADV_REMOVE
Jeff Dikeb73781c2006-04-18 22:20:24 -0700170#define MADV_REMOVE KERNEL_MADV_REMOVE
Jeff Dike02dea082006-03-31 02:30:08 -0800171#endif
172
Jeff Dike97a1fcb2007-07-23 18:43:48 -0700173int os_drop_memory(void *addr, int length)
Jeff Dike02dea082006-03-31 02:30:08 -0800174{
175 int err;
176
177 err = madvise(addr, length, MADV_REMOVE);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700178 if (err < 0)
Jeff Dike02dea082006-03-31 02:30:08 -0800179 err = -errno;
180 return err;
181}
182
Jeff Dike36e45462007-05-06 14:51:11 -0700183int __init can_drop_memory(void)
Jeff Dike02dea082006-03-31 02:30:08 -0800184{
185 void *addr;
Jeff Dikee3104f52006-05-01 12:15:58 -0700186 int fd, ok = 0;
Jeff Dike02dea082006-03-31 02:30:08 -0800187
Jeff Dikeba180fd2007-10-16 01:27:00 -0700188 printk(UM_KERN_INFO "Checking host MADV_REMOVE support...");
Jeff Dike02dea082006-03-31 02:30:08 -0800189 fd = create_mem_file(UM_KERN_PAGE_SIZE);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700190 if (fd < 0) {
191 printk(UM_KERN_ERR "Creating test memory file failed, "
192 "err = %d\n", -fd);
Jeff Dikee3104f52006-05-01 12:15:58 -0700193 goto out;
Jeff Dike02dea082006-03-31 02:30:08 -0800194 }
195
196 addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE,
Jeff Dikeb73781c2006-04-18 22:20:24 -0700197 MAP_SHARED, fd, 0);
Jeff Dikeba180fd2007-10-16 01:27:00 -0700198 if (addr == MAP_FAILED) {
199 printk(UM_KERN_ERR "Mapping test memory file failed, "
200 "err = %d\n", -errno);
Jeff Dikee3104f52006-05-01 12:15:58 -0700201 goto out_close;
Jeff Dike02dea082006-03-31 02:30:08 -0800202 }
203
Jeff Dikeba180fd2007-10-16 01:27:00 -0700204 if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) {
205 printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno);
Jeff Dikee3104f52006-05-01 12:15:58 -0700206 goto out_unmap;
Jeff Dike02dea082006-03-31 02:30:08 -0800207 }
208
Jeff Dike5134d8f2008-02-08 04:22:08 -0800209 printk(UM_KERN_CONT "OK\n");
Jeff Dikee3104f52006-05-01 12:15:58 -0700210 ok = 1;
211
212out_unmap:
213 munmap(addr, UM_KERN_PAGE_SIZE);
214out_close:
215 close(fd);
216out:
217 return ok;
Jeff Dike02dea082006-03-31 02:30:08 -0800218}
219
Richard Weinbergerf75b1b12013-08-17 18:46:00 +0200220static int os_page_mincore(void *addr)
221{
222 char vec[2];
223 int ret;
224
225 ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
226 if (ret < 0) {
227 if (errno == ENOMEM || errno == EINVAL)
228 return 0;
229 else
230 return -errno;
231 }
232
233 return vec[0] & 1;
234}
235
236int os_mincore(void *addr, unsigned long len)
237{
238 char *vec;
239 int ret, i;
240
241 if (len <= UM_KERN_PAGE_SIZE)
242 return os_page_mincore(addr);
243
244 vec = calloc(1, (len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE);
245 if (!vec)
246 return -ENOMEM;
247
248 ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
249 if (ret < 0) {
250 if (errno == ENOMEM || errno == EINVAL)
251 ret = 0;
252 else
253 ret = -errno;
254
255 goto out;
256 }
257
258 for (i = 0; i < ((len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE); i++) {
259 if (!(vec[i] & 1)) {
260 ret = 0;
261 goto out;
262 }
263 }
264
265 ret = 1;
266out:
267 free(vec);
268 return ret;
269}
270
Jeff Dikee64bd132006-07-10 04:45:07 -0700271void init_new_thread_signals(void)
Gennady Sharapov60d339f62005-09-03 15:57:47 -0700272{
Al Viro00361682011-08-18 20:04:39 +0100273 set_handler(SIGSEGV);
274 set_handler(SIGTRAP);
275 set_handler(SIGFPE);
276 set_handler(SIGILL);
277 set_handler(SIGBUS);
Gennady Sharapov60d339f62005-09-03 15:57:47 -0700278 signal(SIGHUP, SIG_IGN);
Al Viro00361682011-08-18 20:04:39 +0100279 set_handler(SIGIO);
Jeff Dike3a24ebf2008-02-04 22:31:16 -0800280 signal(SIGWINCH, SIG_IGN);
Gennady Sharapov60d339f62005-09-03 15:57:47 -0700281}