ppc/pnv: add a PSI bridge class model
[qemu/ar7.git] / util / oslib-posix.c
blob326d92dcd2db9c814d33c175175af69675edebc8
1 /*
2 * os-posix-lib.c
4 * Copyright (c) 2003-2008 Fabrice Bellard
5 * Copyright (c) 2010 Red Hat, Inc.
7 * QEMU library functions on POSIX which are shared between QEMU and
8 * the QEMU tools.
10 * Permission is hereby granted, free of charge, to any person obtaining a copy
11 * of this software and associated documentation files (the "Software"), to deal
12 * in the Software without restriction, including without limitation the rights
13 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
14 * copies of the Software, and to permit persons to whom the Software is
15 * furnished to do so, subject to the following conditions:
17 * The above copyright notice and this permission notice shall be included in
18 * all copies or substantial portions of the Software.
20 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
21 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
22 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
23 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
24 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
25 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
26 * THE SOFTWARE.
29 #include "qemu/osdep.h"
30 #include <termios.h>
32 #include <glib/gprintf.h>
34 #include "sysemu/sysemu.h"
35 #include "trace.h"
36 #include "qapi/error.h"
37 #include "qemu/sockets.h"
38 #include <libgen.h>
39 #include <sys/signal.h>
40 #include "qemu/cutils.h"
42 #ifdef CONFIG_LINUX
43 #include <sys/syscall.h>
44 #endif
46 #ifdef __FreeBSD__
47 #include <sys/sysctl.h>
48 #include <sys/user.h>
49 #include <libutil.h>
50 #endif
52 #ifdef __NetBSD__
53 #include <sys/sysctl.h>
54 #endif
56 #include "qemu/mmap-alloc.h"
58 #ifdef CONFIG_DEBUG_STACK_USAGE
59 #include "qemu/error-report.h"
60 #endif
62 #define MAX_MEM_PREALLOC_THREAD_COUNT 16
64 struct MemsetThread {
65 char *addr;
66 size_t numpages;
67 size_t hpagesize;
68 QemuThread pgthread;
69 sigjmp_buf env;
71 typedef struct MemsetThread MemsetThread;
73 static MemsetThread *memset_thread;
74 static int memset_num_threads;
75 static bool memset_thread_failed;
77 int qemu_get_thread_id(void)
79 #if defined(__linux__)
80 return syscall(SYS_gettid);
81 #else
82 return getpid();
83 #endif
86 int qemu_daemon(int nochdir, int noclose)
88 return daemon(nochdir, noclose);
91 bool qemu_write_pidfile(const char *path, Error **errp)
93 int fd;
94 char pidstr[32];
96 while (1) {
97 struct stat a, b;
98 struct flock lock = {
99 .l_type = F_WRLCK,
100 .l_whence = SEEK_SET,
101 .l_len = 0,
104 fd = qemu_open(path, O_CREAT | O_WRONLY, S_IRUSR | S_IWUSR);
105 if (fd == -1) {
106 error_setg_errno(errp, errno, "Cannot open pid file");
107 return false;
110 if (fstat(fd, &b) < 0) {
111 error_setg_errno(errp, errno, "Cannot stat file");
112 goto fail_close;
115 if (fcntl(fd, F_SETLK, &lock)) {
116 error_setg_errno(errp, errno, "Cannot lock pid file");
117 goto fail_close;
121 * Now make sure the path we locked is the same one that now
122 * exists on the filesystem.
124 if (stat(path, &a) < 0) {
126 * PID file disappeared, someone else must be racing with
127 * us, so try again.
129 close(fd);
130 continue;
133 if (a.st_ino == b.st_ino) {
134 break;
138 * PID file was recreated, someone else must be racing with
139 * us, so try again.
141 close(fd);
144 if (ftruncate(fd, 0) < 0) {
145 error_setg_errno(errp, errno, "Failed to truncate pid file");
146 goto fail_unlink;
149 snprintf(pidstr, sizeof(pidstr), FMT_pid "\n", getpid());
150 if (write(fd, pidstr, strlen(pidstr)) != strlen(pidstr)) {
151 error_setg(errp, "Failed to write pid file");
152 goto fail_unlink;
155 return true;
157 fail_unlink:
158 unlink(path);
159 fail_close:
160 close(fd);
161 return false;
164 void *qemu_oom_check(void *ptr)
166 if (ptr == NULL) {
167 fprintf(stderr, "Failed to allocate memory: %s\n", strerror(errno));
168 abort();
170 return ptr;
173 void *qemu_try_memalign(size_t alignment, size_t size)
175 void *ptr;
177 if (alignment < sizeof(void*)) {
178 alignment = sizeof(void*);
181 #if defined(CONFIG_POSIX_MEMALIGN)
182 int ret;
183 ret = posix_memalign(&ptr, alignment, size);
184 if (ret != 0) {
185 errno = ret;
186 ptr = NULL;
188 #elif defined(CONFIG_BSD)
189 ptr = valloc(size);
190 #else
191 ptr = memalign(alignment, size);
192 #endif
193 trace_qemu_memalign(alignment, size, ptr);
194 return ptr;
197 void *qemu_memalign(size_t alignment, size_t size)
199 return qemu_oom_check(qemu_try_memalign(alignment, size));
202 /* alloc shared memory pages */
203 void *qemu_anon_ram_alloc(size_t size, uint64_t *alignment, bool shared)
205 size_t align = QEMU_VMALLOC_ALIGN;
206 void *ptr = qemu_ram_mmap(-1, size, align, shared);
208 if (ptr == MAP_FAILED) {
209 return NULL;
212 if (alignment) {
213 *alignment = align;
216 trace_qemu_anon_ram_alloc(size, ptr);
217 return ptr;
220 void qemu_vfree(void *ptr)
222 trace_qemu_vfree(ptr);
223 free(ptr);
226 void qemu_anon_ram_free(void *ptr, size_t size)
228 trace_qemu_anon_ram_free(ptr, size);
229 qemu_ram_munmap(-1, ptr, size);
232 void qemu_set_block(int fd)
234 int f;
235 f = fcntl(fd, F_GETFL);
236 assert(f != -1);
237 f = fcntl(fd, F_SETFL, f & ~O_NONBLOCK);
238 assert(f != -1);
241 void qemu_set_nonblock(int fd)
243 int f;
244 f = fcntl(fd, F_GETFL);
245 assert(f != -1);
246 f = fcntl(fd, F_SETFL, f | O_NONBLOCK);
247 #ifdef __OpenBSD__
248 if (f == -1) {
250 * Previous to OpenBSD 6.3, fcntl(F_SETFL) is not permitted on
251 * memory devices and sets errno to ENODEV.
252 * It's OK if we fail to set O_NONBLOCK on devices like /dev/null,
253 * because they will never block anyway.
255 assert(errno == ENODEV);
257 #else
258 assert(f != -1);
259 #endif
262 int socket_set_fast_reuse(int fd)
264 int val = 1, ret;
266 ret = setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
267 (const char *)&val, sizeof(val));
269 assert(ret == 0);
271 return ret;
274 void qemu_set_cloexec(int fd)
276 int f;
277 f = fcntl(fd, F_GETFD);
278 assert(f != -1);
279 f = fcntl(fd, F_SETFD, f | FD_CLOEXEC);
280 assert(f != -1);
284 * Creates a pipe with FD_CLOEXEC set on both file descriptors
286 int qemu_pipe(int pipefd[2])
288 int ret;
290 #ifdef CONFIG_PIPE2
291 ret = pipe2(pipefd, O_CLOEXEC);
292 if (ret != -1 || errno != ENOSYS) {
293 return ret;
295 #endif
296 ret = pipe(pipefd);
297 if (ret == 0) {
298 qemu_set_cloexec(pipefd[0]);
299 qemu_set_cloexec(pipefd[1]);
302 return ret;
305 char *
306 qemu_get_local_state_pathname(const char *relative_pathname)
308 return g_strdup_printf("%s/%s", CONFIG_QEMU_LOCALSTATEDIR,
309 relative_pathname);
312 void qemu_set_tty_echo(int fd, bool echo)
314 struct termios tty;
316 tcgetattr(fd, &tty);
318 if (echo) {
319 tty.c_lflag |= ECHO | ECHONL | ICANON | IEXTEN;
320 } else {
321 tty.c_lflag &= ~(ECHO | ECHONL | ICANON | IEXTEN);
324 tcsetattr(fd, TCSANOW, &tty);
327 static char exec_dir[PATH_MAX];
329 void qemu_init_exec_dir(const char *argv0)
331 char *dir;
332 char *p = NULL;
333 char buf[PATH_MAX];
335 assert(!exec_dir[0]);
337 #if defined(__linux__)
339 int len;
340 len = readlink("/proc/self/exe", buf, sizeof(buf) - 1);
341 if (len > 0) {
342 buf[len] = 0;
343 p = buf;
346 #elif defined(__FreeBSD__) \
347 || (defined(__NetBSD__) && defined(KERN_PROC_PATHNAME))
349 #if defined(__FreeBSD__)
350 static int mib[4] = {CTL_KERN, KERN_PROC, KERN_PROC_PATHNAME, -1};
351 #else
352 static int mib[4] = {CTL_KERN, KERN_PROC_ARGS, -1, KERN_PROC_PATHNAME};
353 #endif
354 size_t len = sizeof(buf) - 1;
356 *buf = '\0';
357 if (!sysctl(mib, ARRAY_SIZE(mib), buf, &len, NULL, 0) &&
358 *buf) {
359 buf[sizeof(buf) - 1] = '\0';
360 p = buf;
363 #endif
364 /* If we don't have any way of figuring out the actual executable
365 location then try argv[0]. */
366 if (!p) {
367 if (!argv0) {
368 return;
370 p = realpath(argv0, buf);
371 if (!p) {
372 return;
375 dir = g_path_get_dirname(p);
377 pstrcpy(exec_dir, sizeof(exec_dir), dir);
379 g_free(dir);
382 char *qemu_get_exec_dir(void)
384 return g_strdup(exec_dir);
387 static void sigbus_handler(int signal)
389 int i;
390 if (memset_thread) {
391 for (i = 0; i < memset_num_threads; i++) {
392 if (qemu_thread_is_self(&memset_thread[i].pgthread)) {
393 siglongjmp(memset_thread[i].env, 1);
399 static void *do_touch_pages(void *arg)
401 MemsetThread *memset_args = (MemsetThread *)arg;
402 sigset_t set, oldset;
404 /* unblock SIGBUS */
405 sigemptyset(&set);
406 sigaddset(&set, SIGBUS);
407 pthread_sigmask(SIG_UNBLOCK, &set, &oldset);
409 if (sigsetjmp(memset_args->env, 1)) {
410 memset_thread_failed = true;
411 } else {
412 char *addr = memset_args->addr;
413 size_t numpages = memset_args->numpages;
414 size_t hpagesize = memset_args->hpagesize;
415 size_t i;
416 for (i = 0; i < numpages; i++) {
418 * Read & write back the same value, so we don't
419 * corrupt existing user/app data that might be
420 * stored.
422 * 'volatile' to stop compiler optimizing this away
423 * to a no-op
425 * TODO: get a better solution from kernel so we
426 * don't need to write at all so we don't cause
427 * wear on the storage backing the region...
429 *(volatile char *)addr = *addr;
430 addr += hpagesize;
433 pthread_sigmask(SIG_SETMASK, &oldset, NULL);
434 return NULL;
437 static inline int get_memset_num_threads(int smp_cpus)
439 long host_procs = sysconf(_SC_NPROCESSORS_ONLN);
440 int ret = 1;
442 if (host_procs > 0) {
443 ret = MIN(MIN(host_procs, MAX_MEM_PREALLOC_THREAD_COUNT), smp_cpus);
445 /* In case sysconf() fails, we fall back to single threaded */
446 return ret;
449 static bool touch_all_pages(char *area, size_t hpagesize, size_t numpages,
450 int smp_cpus)
452 size_t numpages_per_thread;
453 size_t size_per_thread;
454 char *addr = area;
455 int i = 0;
457 memset_thread_failed = false;
458 memset_num_threads = get_memset_num_threads(smp_cpus);
459 memset_thread = g_new0(MemsetThread, memset_num_threads);
460 numpages_per_thread = (numpages / memset_num_threads);
461 size_per_thread = (hpagesize * numpages_per_thread);
462 for (i = 0; i < memset_num_threads; i++) {
463 memset_thread[i].addr = addr;
464 memset_thread[i].numpages = (i == (memset_num_threads - 1)) ?
465 numpages : numpages_per_thread;
466 memset_thread[i].hpagesize = hpagesize;
467 qemu_thread_create(&memset_thread[i].pgthread, "touch_pages",
468 do_touch_pages, &memset_thread[i],
469 QEMU_THREAD_JOINABLE);
470 addr += size_per_thread;
471 numpages -= numpages_per_thread;
473 for (i = 0; i < memset_num_threads; i++) {
474 qemu_thread_join(&memset_thread[i].pgthread);
476 g_free(memset_thread);
477 memset_thread = NULL;
479 return memset_thread_failed;
482 void os_mem_prealloc(int fd, char *area, size_t memory, int smp_cpus,
483 Error **errp)
485 int ret;
486 struct sigaction act, oldact;
487 size_t hpagesize = qemu_fd_getpagesize(fd);
488 size_t numpages = DIV_ROUND_UP(memory, hpagesize);
490 memset(&act, 0, sizeof(act));
491 act.sa_handler = &sigbus_handler;
492 act.sa_flags = 0;
494 ret = sigaction(SIGBUS, &act, &oldact);
495 if (ret) {
496 error_setg_errno(errp, errno,
497 "os_mem_prealloc: failed to install signal handler");
498 return;
501 /* touch pages simultaneously */
502 if (touch_all_pages(area, hpagesize, numpages, smp_cpus)) {
503 error_setg(errp, "os_mem_prealloc: Insufficient free host memory "
504 "pages available to allocate guest RAM");
507 ret = sigaction(SIGBUS, &oldact, NULL);
508 if (ret) {
509 /* Terminate QEMU since it can't recover from error */
510 perror("os_mem_prealloc: failed to reinstall signal handler");
511 exit(1);
516 char *qemu_get_pid_name(pid_t pid)
518 char *name = NULL;
520 #if defined(__FreeBSD__)
521 /* BSDs don't have /proc, but they provide a nice substitute */
522 struct kinfo_proc *proc = kinfo_getproc(pid);
524 if (proc) {
525 name = g_strdup(proc->ki_comm);
526 free(proc);
528 #else
529 /* Assume a system with reasonable procfs */
530 char *pid_path;
531 size_t len;
533 pid_path = g_strdup_printf("/proc/%d/cmdline", pid);
534 g_file_get_contents(pid_path, &name, &len, NULL);
535 g_free(pid_path);
536 #endif
538 return name;
542 pid_t qemu_fork(Error **errp)
544 sigset_t oldmask, newmask;
545 struct sigaction sig_action;
546 int saved_errno;
547 pid_t pid;
550 * Need to block signals now, so that child process can safely
551 * kill off caller's signal handlers without a race.
553 sigfillset(&newmask);
554 if (pthread_sigmask(SIG_SETMASK, &newmask, &oldmask) != 0) {
555 error_setg_errno(errp, errno,
556 "cannot block signals");
557 return -1;
560 pid = fork();
561 saved_errno = errno;
563 if (pid < 0) {
564 /* attempt to restore signal mask, but ignore failure, to
565 * avoid obscuring the fork failure */
566 (void)pthread_sigmask(SIG_SETMASK, &oldmask, NULL);
567 error_setg_errno(errp, saved_errno,
568 "cannot fork child process");
569 errno = saved_errno;
570 return -1;
571 } else if (pid) {
572 /* parent process */
574 /* Restore our original signal mask now that the child is
575 * safely running. Only documented failures are EFAULT (not
576 * possible, since we are using just-grabbed mask) or EINVAL
577 * (not possible, since we are using correct arguments). */
578 (void)pthread_sigmask(SIG_SETMASK, &oldmask, NULL);
579 } else {
580 /* child process */
581 size_t i;
583 /* Clear out all signal handlers from parent so nothing
584 * unexpected can happen in our child once we unblock
585 * signals */
586 sig_action.sa_handler = SIG_DFL;
587 sig_action.sa_flags = 0;
588 sigemptyset(&sig_action.sa_mask);
590 for (i = 1; i < NSIG; i++) {
591 /* Only possible errors are EFAULT or EINVAL The former
592 * won't happen, the latter we expect, so no need to check
593 * return value */
594 (void)sigaction(i, &sig_action, NULL);
597 /* Unmask all signals in child, since we've no idea what the
598 * caller's done with their signal mask and don't want to
599 * propagate that to children */
600 sigemptyset(&newmask);
601 if (pthread_sigmask(SIG_SETMASK, &newmask, NULL) != 0) {
602 Error *local_err = NULL;
603 error_setg_errno(&local_err, errno,
604 "cannot unblock signals");
605 error_report_err(local_err);
606 _exit(1);
609 return pid;
612 void *qemu_alloc_stack(size_t *sz)
614 void *ptr, *guardpage;
615 int flags;
616 #ifdef CONFIG_DEBUG_STACK_USAGE
617 void *ptr2;
618 #endif
619 size_t pagesz = getpagesize();
620 #ifdef _SC_THREAD_STACK_MIN
621 /* avoid stacks smaller than _SC_THREAD_STACK_MIN */
622 long min_stack_sz = sysconf(_SC_THREAD_STACK_MIN);
623 *sz = MAX(MAX(min_stack_sz, 0), *sz);
624 #endif
625 /* adjust stack size to a multiple of the page size */
626 *sz = ROUND_UP(*sz, pagesz);
627 /* allocate one extra page for the guard page */
628 *sz += pagesz;
630 flags = MAP_PRIVATE | MAP_ANONYMOUS;
631 #if defined(MAP_STACK) && defined(__OpenBSD__)
632 /* Only enable MAP_STACK on OpenBSD. Other OS's such as
633 * Linux/FreeBSD/NetBSD have a flag with the same name
634 * but have differing functionality. OpenBSD will SEGV
635 * if it spots execution with a stack pointer pointing
636 * at memory that was not allocated with MAP_STACK.
638 flags |= MAP_STACK;
639 #endif
641 ptr = mmap(NULL, *sz, PROT_READ | PROT_WRITE, flags, -1, 0);
642 if (ptr == MAP_FAILED) {
643 perror("failed to allocate memory for stack");
644 abort();
647 #if defined(HOST_IA64)
648 /* separate register stack */
649 guardpage = ptr + (((*sz - pagesz) / 2) & ~pagesz);
650 #elif defined(HOST_HPPA)
651 /* stack grows up */
652 guardpage = ptr + *sz - pagesz;
653 #else
654 /* stack grows down */
655 guardpage = ptr;
656 #endif
657 if (mprotect(guardpage, pagesz, PROT_NONE) != 0) {
658 perror("failed to set up stack guard page");
659 abort();
662 #ifdef CONFIG_DEBUG_STACK_USAGE
663 for (ptr2 = ptr + pagesz; ptr2 < ptr + *sz; ptr2 += sizeof(uint32_t)) {
664 *(uint32_t *)ptr2 = 0xdeadbeaf;
666 #endif
668 return ptr;
671 #ifdef CONFIG_DEBUG_STACK_USAGE
672 static __thread unsigned int max_stack_usage;
673 #endif
675 void qemu_free_stack(void *stack, size_t sz)
677 #ifdef CONFIG_DEBUG_STACK_USAGE
678 unsigned int usage;
679 void *ptr;
681 for (ptr = stack + getpagesize(); ptr < stack + sz;
682 ptr += sizeof(uint32_t)) {
683 if (*(uint32_t *)ptr != 0xdeadbeaf) {
684 break;
687 usage = sz - (uintptr_t) (ptr - stack);
688 if (usage > max_stack_usage) {
689 error_report("thread %d max stack usage increased from %u to %u",
690 qemu_get_thread_id(), max_stack_usage, usage);
691 max_stack_usage = usage;
693 #endif
695 munmap(stack, sz);
698 void sigaction_invoke(struct sigaction *action,
699 struct qemu_signalfd_siginfo *info)
701 siginfo_t si = {};
702 si.si_signo = info->ssi_signo;
703 si.si_errno = info->ssi_errno;
704 si.si_code = info->ssi_code;
706 /* Convert the minimal set of fields defined by POSIX.
707 * Positive si_code values are reserved for kernel-generated
708 * signals, where the valid siginfo fields are determined by
709 * the signal number. But according to POSIX, it is unspecified
710 * whether SI_USER and SI_QUEUE have values less than or equal to
711 * zero.
713 if (info->ssi_code == SI_USER || info->ssi_code == SI_QUEUE ||
714 info->ssi_code <= 0) {
715 /* SIGTERM, etc. */
716 si.si_pid = info->ssi_pid;
717 si.si_uid = info->ssi_uid;
718 } else if (info->ssi_signo == SIGILL || info->ssi_signo == SIGFPE ||
719 info->ssi_signo == SIGSEGV || info->ssi_signo == SIGBUS) {
720 si.si_addr = (void *)(uintptr_t)info->ssi_addr;
721 } else if (info->ssi_signo == SIGCHLD) {
722 si.si_pid = info->ssi_pid;
723 si.si_status = info->ssi_status;
724 si.si_uid = info->ssi_uid;
726 action->sa_sigaction(info->ssi_signo, &si, NULL);