Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2015 Thomas Meyer (thomas@m3y3r.de)
  4 * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
 
  5 */
  6
  7#include <stdio.h>
  8#include <stdlib.h>
  9#include <unistd.h>
 10#include <errno.h>
 11#include <signal.h>
 12#include <fcntl.h>
 13#include <sys/mman.h>
 14#include <sys/ptrace.h>
 15#include <sys/wait.h>
 16#include <asm/unistd.h>
 17#include <init.h>
 18#include <longjmp.h>
 19#include <os.h>
 
 
 
 
 20
 21#define ARBITRARY_ADDR -1
 22#define FAILURE_PID    -1
 23
 24#define STAT_PATH_LEN sizeof("/proc/#######/stat\0")
 25#define COMM_SCANF "%*[^)])"
 26
 27unsigned long os_process_pc(int pid)
 28{
 29	char proc_stat[STAT_PATH_LEN], buf[256];
 30	unsigned long pc = ARBITRARY_ADDR;
 31	int fd, err;
 32
 33	sprintf(proc_stat, "/proc/%d/stat", pid);
 34	fd = open(proc_stat, O_RDONLY, 0);
 35	if (fd < 0) {
 36		printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', "
 37		       "errno = %d\n", proc_stat, errno);
 38		goto out;
 39	}
 40	CATCH_EINTR(err = read(fd, buf, sizeof(buf)));
 41	if (err < 0) {
 42		printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', "
 43		       "err = %d\n", proc_stat, errno);
 44		goto out_close;
 45	}
 46	os_close_file(fd);
 47	pc = ARBITRARY_ADDR;
 48	if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d "
 49		   "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d "
 50		   "%*d %*d %*d %*d %*d %lu", &pc) != 1)
 51		printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n",
 52		       buf);
 53 out_close:
 54	close(fd);
 55 out:
 56	return pc;
 57}
 58
 59int os_process_parent(int pid)
 60{
 61	char stat[STAT_PATH_LEN];
 62	char data[256];
 63	int parent = FAILURE_PID, n, fd;
 64
 65	if (pid == -1)
 66		return parent;
 67
 68	snprintf(stat, sizeof(stat), "/proc/%d/stat", pid);
 69	fd = open(stat, O_RDONLY, 0);
 70	if (fd < 0) {
 71		printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat,
 72		       errno);
 73		return parent;
 74	}
 75
 76	CATCH_EINTR(n = read(fd, data, sizeof(data)));
 77	close(fd);
 78
 79	if (n < 0) {
 80		printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat,
 81		       errno);
 82		return parent;
 83	}
 84
 85	parent = FAILURE_PID;
 86	n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent);
 87	if (n != 1)
 88		printk(UM_KERN_ERR "Failed to scan '%s'\n", data);
 89
 90	return parent;
 91}
 92
 93void os_alarm_process(int pid)
 94{
 95	kill(pid, SIGALRM);
 96}
 97
 98void os_stop_process(int pid)
 99{
100	kill(pid, SIGSTOP);
101}
102
103void os_kill_process(int pid, int reap_child)
104{
105	kill(pid, SIGKILL);
106	if (reap_child)
107		CATCH_EINTR(waitpid(pid, NULL, __WALL));
108}
109
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
110/* Kill off a ptraced child by all means available.  kill it normally first,
111 * then PTRACE_KILL it, then PTRACE_CONT it in case it's in a run state from
112 * which it can't exit directly.
113 */
114
115void os_kill_ptraced_process(int pid, int reap_child)
116{
117	kill(pid, SIGKILL);
118	ptrace(PTRACE_KILL, pid);
119	ptrace(PTRACE_CONT, pid);
120	if (reap_child)
121		CATCH_EINTR(waitpid(pid, NULL, __WALL));
122}
123
124/* Don't use the glibc version, which caches the result in TLS. It misses some
125 * syscalls, and also breaks with clone(), which does not unshare the TLS.
126 */
127
128int os_getpid(void)
129{
130	return syscall(__NR_getpid);
131}
132
133int os_getpgrp(void)
134{
135	return getpgrp();
136}
137
138int os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len,
139		  int r, int w, int x)
140{
141	void *loc;
142	int prot;
143
144	prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
145		(x ? PROT_EXEC : 0);
146
147	loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED,
148		     fd, off);
149	if (loc == MAP_FAILED)
150		return -errno;
151	return 0;
152}
153
154int os_protect_memory(void *addr, unsigned long len, int r, int w, int x)
155{
156	int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
157		    (x ? PROT_EXEC : 0));
158
159	if (mprotect(addr, len, prot) < 0)
160		return -errno;
161
162	return 0;
163}
164
165int os_unmap_memory(void *addr, int len)
166{
167	int err;
168
169	err = munmap(addr, len);
170	if (err < 0)
171		return -errno;
172	return 0;
173}
174
175#ifndef MADV_REMOVE
176#define MADV_REMOVE KERNEL_MADV_REMOVE
177#endif
178
179int os_drop_memory(void *addr, int length)
180{
181	int err;
182
183	err = madvise(addr, length, MADV_REMOVE);
184	if (err < 0)
185		err = -errno;
186	return err;
187}
188
189int __init can_drop_memory(void)
190{
191	void *addr;
192	int fd, ok = 0;
193
194	printk(UM_KERN_INFO "Checking host MADV_REMOVE support...");
195	fd = create_mem_file(UM_KERN_PAGE_SIZE);
196	if (fd < 0) {
197		printk(UM_KERN_ERR "Creating test memory file failed, "
198		       "err = %d\n", -fd);
199		goto out;
200	}
201
202	addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE,
203		      MAP_SHARED, fd, 0);
204	if (addr == MAP_FAILED) {
205		printk(UM_KERN_ERR "Mapping test memory file failed, "
206		       "err = %d\n", -errno);
207		goto out_close;
208	}
209
210	if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) {
211		printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno);
212		goto out_unmap;
213	}
214
215	printk(UM_KERN_CONT "OK\n");
216	ok = 1;
217
218out_unmap:
219	munmap(addr, UM_KERN_PAGE_SIZE);
220out_close:
221	close(fd);
222out:
223	return ok;
224}
225
226static int os_page_mincore(void *addr)
227{
228	char vec[2];
229	int ret;
230
231	ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
232	if (ret < 0) {
233		if (errno == ENOMEM || errno == EINVAL)
234			return 0;
235		else
236			return -errno;
237	}
 
238
239	return vec[0] & 1;
 
 
 
 
240}
241
242int os_mincore(void *addr, unsigned long len)
243{
244	char *vec;
245	int ret, i;
246
247	if (len <= UM_KERN_PAGE_SIZE)
248		return os_page_mincore(addr);
249
250	vec = calloc(1, (len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE);
251	if (!vec)
252		return -ENOMEM;
253
254	ret = mincore(addr, UM_KERN_PAGE_SIZE, vec);
255	if (ret < 0) {
256		if (errno == ENOMEM || errno == EINVAL)
257			ret = 0;
258		else
259			ret = -errno;
260
261		goto out;
262	}
263
264	for (i = 0; i < ((len + UM_KERN_PAGE_SIZE - 1) / UM_KERN_PAGE_SIZE); i++) {
265		if (!(vec[i] & 1)) {
266			ret = 0;
267			goto out;
268		}
269	}
270
271	ret = 1;
272out:
273	free(vec);
274	return ret;
275}
276
277void init_new_thread_signals(void)
278{
279	set_handler(SIGSEGV);
280	set_handler(SIGTRAP);
281	set_handler(SIGFPE);
282	set_handler(SIGILL);
283	set_handler(SIGBUS);
284	signal(SIGHUP, SIG_IGN);
285	set_handler(SIGIO);
286	signal(SIGWINCH, SIG_IGN);
287}
v3.1
 
  1/*
 
  2 * Copyright (C) 2002 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
  3 * Licensed under the GPL
  4 */
  5
  6#include <stdio.h>
 
  7#include <unistd.h>
  8#include <errno.h>
  9#include <signal.h>
 10#include <fcntl.h>
 11#include <sys/mman.h>
 12#include <sys/ptrace.h>
 13#include <sys/wait.h>
 14#include <asm/unistd.h>
 15#include "init.h"
 16#include "kern_constants.h"
 17#include "longjmp.h"
 18#include "os.h"
 19#include "process.h"
 20#include "skas_ptrace.h"
 21#include "user.h"
 22
 23#define ARBITRARY_ADDR -1
 24#define FAILURE_PID    -1
 25
 26#define STAT_PATH_LEN sizeof("/proc/#######/stat\0")
 27#define COMM_SCANF "%*[^)])"
 28
 29unsigned long os_process_pc(int pid)
 30{
 31	char proc_stat[STAT_PATH_LEN], buf[256];
 32	unsigned long pc = ARBITRARY_ADDR;
 33	int fd, err;
 34
 35	sprintf(proc_stat, "/proc/%d/stat", pid);
 36	fd = open(proc_stat, O_RDONLY, 0);
 37	if (fd < 0) {
 38		printk(UM_KERN_ERR "os_process_pc - couldn't open '%s', "
 39		       "errno = %d\n", proc_stat, errno);
 40		goto out;
 41	}
 42	CATCH_EINTR(err = read(fd, buf, sizeof(buf)));
 43	if (err < 0) {
 44		printk(UM_KERN_ERR "os_process_pc - couldn't read '%s', "
 45		       "err = %d\n", proc_stat, errno);
 46		goto out_close;
 47	}
 48	os_close_file(fd);
 49	pc = ARBITRARY_ADDR;
 50	if (sscanf(buf, "%*d " COMM_SCANF " %*c %*d %*d %*d %*d %*d %*d %*d "
 51		   "%*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d %*d "
 52		   "%*d %*d %*d %*d %*d %lu", &pc) != 1)
 53		printk(UM_KERN_ERR "os_process_pc - couldn't find pc in '%s'\n",
 54		       buf);
 55 out_close:
 56	close(fd);
 57 out:
 58	return pc;
 59}
 60
 61int os_process_parent(int pid)
 62{
 63	char stat[STAT_PATH_LEN];
 64	char data[256];
 65	int parent = FAILURE_PID, n, fd;
 66
 67	if (pid == -1)
 68		return parent;
 69
 70	snprintf(stat, sizeof(stat), "/proc/%d/stat", pid);
 71	fd = open(stat, O_RDONLY, 0);
 72	if (fd < 0) {
 73		printk(UM_KERN_ERR "Couldn't open '%s', errno = %d\n", stat,
 74		       errno);
 75		return parent;
 76	}
 77
 78	CATCH_EINTR(n = read(fd, data, sizeof(data)));
 79	close(fd);
 80
 81	if (n < 0) {
 82		printk(UM_KERN_ERR "Couldn't read '%s', errno = %d\n", stat,
 83		       errno);
 84		return parent;
 85	}
 86
 87	parent = FAILURE_PID;
 88	n = sscanf(data, "%*d " COMM_SCANF " %*c %d", &parent);
 89	if (n != 1)
 90		printk(UM_KERN_ERR "Failed to scan '%s'\n", data);
 91
 92	return parent;
 93}
 94
 
 
 
 
 
 95void os_stop_process(int pid)
 96{
 97	kill(pid, SIGSTOP);
 98}
 99
100void os_kill_process(int pid, int reap_child)
101{
102	kill(pid, SIGKILL);
103	if (reap_child)
104		CATCH_EINTR(waitpid(pid, NULL, __WALL));
105}
106
107/* This is here uniquely to have access to the userspace errno, i.e. the one
108 * used by ptrace in case of error.
109 */
110
111long os_ptrace_ldt(long pid, long addr, long data)
112{
113	int ret;
114
115	ret = ptrace(PTRACE_LDT, pid, addr, data);
116
117	if (ret < 0)
118		return -errno;
119	return ret;
120}
121
122/* Kill off a ptraced child by all means available.  kill it normally first,
123 * then PTRACE_KILL it, then PTRACE_CONT it in case it's in a run state from
124 * which it can't exit directly.
125 */
126
127void os_kill_ptraced_process(int pid, int reap_child)
128{
129	kill(pid, SIGKILL);
130	ptrace(PTRACE_KILL, pid);
131	ptrace(PTRACE_CONT, pid);
132	if (reap_child)
133		CATCH_EINTR(waitpid(pid, NULL, __WALL));
134}
135
136/* Don't use the glibc version, which caches the result in TLS. It misses some
137 * syscalls, and also breaks with clone(), which does not unshare the TLS.
138 */
139
140int os_getpid(void)
141{
142	return syscall(__NR_getpid);
143}
144
145int os_getpgrp(void)
146{
147	return getpgrp();
148}
149
150int os_map_memory(void *virt, int fd, unsigned long long off, unsigned long len,
151		  int r, int w, int x)
152{
153	void *loc;
154	int prot;
155
156	prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
157		(x ? PROT_EXEC : 0);
158
159	loc = mmap64((void *) virt, len, prot, MAP_SHARED | MAP_FIXED,
160		     fd, off);
161	if (loc == MAP_FAILED)
162		return -errno;
163	return 0;
164}
165
166int os_protect_memory(void *addr, unsigned long len, int r, int w, int x)
167{
168	int prot = ((r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
169		    (x ? PROT_EXEC : 0));
170
171	if (mprotect(addr, len, prot) < 0)
172		return -errno;
173
174	return 0;
175}
176
177int os_unmap_memory(void *addr, int len)
178{
179	int err;
180
181	err = munmap(addr, len);
182	if (err < 0)
183		return -errno;
184	return 0;
185}
186
187#ifndef MADV_REMOVE
188#define MADV_REMOVE KERNEL_MADV_REMOVE
189#endif
190
191int os_drop_memory(void *addr, int length)
192{
193	int err;
194
195	err = madvise(addr, length, MADV_REMOVE);
196	if (err < 0)
197		err = -errno;
198	return err;
199}
200
201int __init can_drop_memory(void)
202{
203	void *addr;
204	int fd, ok = 0;
205
206	printk(UM_KERN_INFO "Checking host MADV_REMOVE support...");
207	fd = create_mem_file(UM_KERN_PAGE_SIZE);
208	if (fd < 0) {
209		printk(UM_KERN_ERR "Creating test memory file failed, "
210		       "err = %d\n", -fd);
211		goto out;
212	}
213
214	addr = mmap64(NULL, UM_KERN_PAGE_SIZE, PROT_READ | PROT_WRITE,
215		      MAP_SHARED, fd, 0);
216	if (addr == MAP_FAILED) {
217		printk(UM_KERN_ERR "Mapping test memory file failed, "
218		       "err = %d\n", -errno);
219		goto out_close;
220	}
221
222	if (madvise(addr, UM_KERN_PAGE_SIZE, MADV_REMOVE) != 0) {
223		printk(UM_KERN_ERR "MADV_REMOVE failed, err = %d\n", -errno);
224		goto out_unmap;
225	}
226
227	printk(UM_KERN_CONT "OK\n");
228	ok = 1;
229
230out_unmap:
231	munmap(addr, UM_KERN_PAGE_SIZE);
232out_close:
233	close(fd);
234out:
235	return ok;
236}
237
238void init_new_thread_signals(void)
239{
240	set_handler(SIGSEGV, (__sighandler_t) sig_handler, SA_ONSTACK,
241		    SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1);
242	set_handler(SIGTRAP, (__sighandler_t) sig_handler, SA_ONSTACK,
243		    SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1);
244	set_handler(SIGFPE, (__sighandler_t) sig_handler, SA_ONSTACK,
245		    SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1);
246	set_handler(SIGILL, (__sighandler_t) sig_handler, SA_ONSTACK,
247		    SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1);
248	set_handler(SIGBUS, (__sighandler_t) sig_handler, SA_ONSTACK,
249		    SIGUSR1, SIGIO, SIGWINCH, SIGVTALRM, -1);
250	signal(SIGHUP, SIG_IGN);
251
252	set_handler(SIGIO, (__sighandler_t) sig_handler,
253		    SA_ONSTACK | SA_RESTART, SIGUSR1, SIGIO, SIGWINCH, SIGALRM,
254		    SIGVTALRM, -1);
255	signal(SIGWINCH, SIG_IGN);
256	signal(SIGTERM, SIG_DFL);
257}
258
259int run_kernel_thread(int (*fn)(void *), void *arg, jmp_buf **jmp_ptr)
260{
261	jmp_buf buf;
262	int n;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
263
264	*jmp_ptr = &buf;
265	n = UML_SETJMP(&buf);
266	if (n != 0)
267		return n;
268	(*fn)(arg);
269	return 0;
 
 
 
 
 
 
 
 
 
 
270}