bugfix: Use gicr_typer in arm_gicv3_icc_reset
[qemu/ar7.git] / util / oslib-posix.c
blob062236a1ab4109666ddc841c5b141eb021a222c4
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 "qemu-common.h"
35 #include "sysemu/sysemu.h"
36 #include "trace.h"
37 #include "qapi/error.h"
38 #include "qemu/sockets.h"
39 #include "qemu/thread.h"
40 #include <libgen.h>
41 #include <sys/signal.h>
42 #include "qemu/cutils.h"
44 #ifdef CONFIG_LINUX
45 #include <sys/syscall.h>
46 #endif
48 #ifdef __FreeBSD__
49 #include <sys/sysctl.h>
50 #include <sys/user.h>
51 #include <libutil.h>
52 #endif
54 #ifdef __NetBSD__
55 #include <sys/sysctl.h>
56 #endif
58 #include "qemu/mmap-alloc.h"
60 #ifdef CONFIG_DEBUG_STACK_USAGE
61 #include "qemu/error-report.h"
62 #endif
64 #define MAX_MEM_PREALLOC_THREAD_COUNT 16
66 struct MemsetThread {
67 char *addr;
68 size_t numpages;
69 size_t hpagesize;
70 QemuThread pgthread;
71 sigjmp_buf env;
73 typedef struct MemsetThread MemsetThread;
75 static MemsetThread *memset_thread;
76 static int memset_num_threads;
77 static bool memset_thread_failed;
79 static QemuMutex page_mutex;
80 static QemuCond page_cond;
81 static bool threads_created_flag;
83 int qemu_get_thread_id(void)
85 #if defined(__linux__)
86 return syscall(SYS_gettid);
87 #else
88 return getpid();
89 #endif
92 int qemu_daemon(int nochdir, int noclose)
94 return daemon(nochdir, noclose);
97 bool qemu_write_pidfile(const char *path, Error **errp)
99 int fd;
100 char pidstr[32];
102 while (1) {
103 struct stat a, b;
104 struct flock lock = {
105 .l_type = F_WRLCK,
106 .l_whence = SEEK_SET,
107 .l_len = 0,
110 fd = qemu_open(path, O_CREAT | O_WRONLY, S_IRUSR | S_IWUSR);
111 if (fd == -1) {
112 error_setg_errno(errp, errno, "Cannot open pid file");
113 return false;
116 if (fstat(fd, &b) < 0) {
117 error_setg_errno(errp, errno, "Cannot stat file");
118 goto fail_close;
121 if (fcntl(fd, F_SETLK, &lock)) {
122 error_setg_errno(errp, errno, "Cannot lock pid file");
123 goto fail_close;
127 * Now make sure the path we locked is the same one that now
128 * exists on the filesystem.
130 if (stat(path, &a) < 0) {
132 * PID file disappeared, someone else must be racing with
133 * us, so try again.
135 close(fd);
136 continue;
139 if (a.st_ino == b.st_ino) {
140 break;
144 * PID file was recreated, someone else must be racing with
145 * us, so try again.
147 close(fd);
150 if (ftruncate(fd, 0) < 0) {
151 error_setg_errno(errp, errno, "Failed to truncate pid file");
152 goto fail_unlink;
155 snprintf(pidstr, sizeof(pidstr), FMT_pid "\n", getpid());
156 if (write(fd, pidstr, strlen(pidstr)) != strlen(pidstr)) {
157 error_setg(errp, "Failed to write pid file");
158 goto fail_unlink;
161 return true;
163 fail_unlink:
164 unlink(path);
165 fail_close:
166 close(fd);
167 return false;
170 void *qemu_oom_check(void *ptr)
172 if (ptr == NULL) {
173 fprintf(stderr, "Failed to allocate memory: %s\n", strerror(errno));
174 abort();
176 return ptr;
179 void *qemu_try_memalign(size_t alignment, size_t size)
181 void *ptr;
183 if (alignment < sizeof(void*)) {
184 alignment = sizeof(void*);
187 #if defined(CONFIG_POSIX_MEMALIGN)
188 int ret;
189 ret = posix_memalign(&ptr, alignment, size);
190 if (ret != 0) {
191 errno = ret;
192 ptr = NULL;
194 #elif defined(CONFIG_BSD)
195 ptr = valloc(size);
196 #else
197 ptr = memalign(alignment, size);
198 #endif
199 trace_qemu_memalign(alignment, size, ptr);
200 return ptr;
203 void *qemu_memalign(size_t alignment, size_t size)
205 return qemu_oom_check(qemu_try_memalign(alignment, size));
208 /* alloc shared memory pages */
209 void *qemu_anon_ram_alloc(size_t size, uint64_t *alignment, bool shared)
211 size_t align = QEMU_VMALLOC_ALIGN;
212 void *ptr = qemu_ram_mmap(-1, size, align, shared, false);
214 if (ptr == MAP_FAILED) {
215 return NULL;
218 if (alignment) {
219 *alignment = align;
222 trace_qemu_anon_ram_alloc(size, ptr);
223 return ptr;
226 void qemu_vfree(void *ptr)
228 trace_qemu_vfree(ptr);
229 free(ptr);
232 void qemu_anon_ram_free(void *ptr, size_t size)
234 trace_qemu_anon_ram_free(ptr, size);
235 qemu_ram_munmap(-1, ptr, size);
238 void qemu_set_block(int fd)
240 int f;
241 f = fcntl(fd, F_GETFL);
242 assert(f != -1);
243 f = fcntl(fd, F_SETFL, f & ~O_NONBLOCK);
244 assert(f != -1);
247 void qemu_set_nonblock(int fd)
249 int f;
250 f = fcntl(fd, F_GETFL);
251 assert(f != -1);
252 f = fcntl(fd, F_SETFL, f | O_NONBLOCK);
253 #ifdef __OpenBSD__
254 if (f == -1) {
256 * Previous to OpenBSD 6.3, fcntl(F_SETFL) is not permitted on
257 * memory devices and sets errno to ENODEV.
258 * It's OK if we fail to set O_NONBLOCK on devices like /dev/null,
259 * because they will never block anyway.
261 assert(errno == ENODEV);
263 #else
264 assert(f != -1);
265 #endif
268 int socket_set_fast_reuse(int fd)
270 int val = 1, ret;
272 ret = setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
273 (const char *)&val, sizeof(val));
275 assert(ret == 0);
277 return ret;
280 void qemu_set_cloexec(int fd)
282 int f;
283 f = fcntl(fd, F_GETFD);
284 assert(f != -1);
285 f = fcntl(fd, F_SETFD, f | FD_CLOEXEC);
286 assert(f != -1);
290 * Creates a pipe with FD_CLOEXEC set on both file descriptors
292 int qemu_pipe(int pipefd[2])
294 int ret;
296 #ifdef CONFIG_PIPE2
297 ret = pipe2(pipefd, O_CLOEXEC);
298 if (ret != -1 || errno != ENOSYS) {
299 return ret;
301 #endif
302 ret = pipe(pipefd);
303 if (ret == 0) {
304 qemu_set_cloexec(pipefd[0]);
305 qemu_set_cloexec(pipefd[1]);
308 return ret;
311 char *
312 qemu_get_local_state_pathname(const char *relative_pathname)
314 return g_strdup_printf("%s/%s", CONFIG_QEMU_LOCALSTATEDIR,
315 relative_pathname);
318 void qemu_set_tty_echo(int fd, bool echo)
320 struct termios tty;
322 tcgetattr(fd, &tty);
324 if (echo) {
325 tty.c_lflag |= ECHO | ECHONL | ICANON | IEXTEN;
326 } else {
327 tty.c_lflag &= ~(ECHO | ECHONL | ICANON | IEXTEN);
330 tcsetattr(fd, TCSANOW, &tty);
333 static char exec_dir[PATH_MAX];
335 void qemu_init_exec_dir(const char *argv0)
337 char *dir;
338 char *p = NULL;
339 char buf[PATH_MAX];
341 assert(!exec_dir[0]);
343 #if defined(__linux__)
345 int len;
346 len = readlink("/proc/self/exe", buf, sizeof(buf) - 1);
347 if (len > 0) {
348 buf[len] = 0;
349 p = buf;
352 #elif defined(__FreeBSD__) \
353 || (defined(__NetBSD__) && defined(KERN_PROC_PATHNAME))
355 #if defined(__FreeBSD__)
356 static int mib[4] = {CTL_KERN, KERN_PROC, KERN_PROC_PATHNAME, -1};
357 #else
358 static int mib[4] = {CTL_KERN, KERN_PROC_ARGS, -1, KERN_PROC_PATHNAME};
359 #endif
360 size_t len = sizeof(buf) - 1;
362 *buf = '\0';
363 if (!sysctl(mib, ARRAY_SIZE(mib), buf, &len, NULL, 0) &&
364 *buf) {
365 buf[sizeof(buf) - 1] = '\0';
366 p = buf;
369 #endif
370 /* If we don't have any way of figuring out the actual executable
371 location then try argv[0]. */
372 if (!p) {
373 if (!argv0) {
374 return;
376 p = realpath(argv0, buf);
377 if (!p) {
378 return;
381 dir = g_path_get_dirname(p);
383 pstrcpy(exec_dir, sizeof(exec_dir), dir);
385 g_free(dir);
388 char *qemu_get_exec_dir(void)
390 return g_strdup(exec_dir);
393 static void sigbus_handler(int signal)
395 int i;
396 if (memset_thread) {
397 for (i = 0; i < memset_num_threads; i++) {
398 if (qemu_thread_is_self(&memset_thread[i].pgthread)) {
399 siglongjmp(memset_thread[i].env, 1);
405 static void *do_touch_pages(void *arg)
407 MemsetThread *memset_args = (MemsetThread *)arg;
408 sigset_t set, oldset;
411 * On Linux, the page faults from the loop below can cause mmap_sem
412 * contention with allocation of the thread stacks. Do not start
413 * clearing until all threads have been created.
415 qemu_mutex_lock(&page_mutex);
416 while(!threads_created_flag){
417 qemu_cond_wait(&page_cond, &page_mutex);
419 qemu_mutex_unlock(&page_mutex);
421 /* unblock SIGBUS */
422 sigemptyset(&set);
423 sigaddset(&set, SIGBUS);
424 pthread_sigmask(SIG_UNBLOCK, &set, &oldset);
426 if (sigsetjmp(memset_args->env, 1)) {
427 memset_thread_failed = true;
428 } else {
429 char *addr = memset_args->addr;
430 size_t numpages = memset_args->numpages;
431 size_t hpagesize = memset_args->hpagesize;
432 size_t i;
433 for (i = 0; i < numpages; i++) {
435 * Read & write back the same value, so we don't
436 * corrupt existing user/app data that might be
437 * stored.
439 * 'volatile' to stop compiler optimizing this away
440 * to a no-op
442 * TODO: get a better solution from kernel so we
443 * don't need to write at all so we don't cause
444 * wear on the storage backing the region...
446 *(volatile char *)addr = *addr;
447 addr += hpagesize;
450 pthread_sigmask(SIG_SETMASK, &oldset, NULL);
451 return NULL;
454 static inline int get_memset_num_threads(int smp_cpus)
456 long host_procs = sysconf(_SC_NPROCESSORS_ONLN);
457 int ret = 1;
459 if (host_procs > 0) {
460 ret = MIN(MIN(host_procs, MAX_MEM_PREALLOC_THREAD_COUNT), smp_cpus);
462 /* In case sysconf() fails, we fall back to single threaded */
463 return ret;
466 static bool touch_all_pages(char *area, size_t hpagesize, size_t numpages,
467 int smp_cpus)
469 static gsize initialized = 0;
470 size_t numpages_per_thread, leftover;
471 char *addr = area;
472 int i = 0;
474 if (g_once_init_enter(&initialized)) {
475 qemu_mutex_init(&page_mutex);
476 qemu_cond_init(&page_cond);
477 g_once_init_leave(&initialized, 1);
480 memset_thread_failed = false;
481 threads_created_flag = false;
482 memset_num_threads = get_memset_num_threads(smp_cpus);
483 memset_thread = g_new0(MemsetThread, memset_num_threads);
484 numpages_per_thread = numpages / memset_num_threads;
485 leftover = numpages % memset_num_threads;
486 for (i = 0; i < memset_num_threads; i++) {
487 memset_thread[i].addr = addr;
488 memset_thread[i].numpages = numpages_per_thread + (i < leftover);
489 memset_thread[i].hpagesize = hpagesize;
490 qemu_thread_create(&memset_thread[i].pgthread, "touch_pages",
491 do_touch_pages, &memset_thread[i],
492 QEMU_THREAD_JOINABLE);
493 addr += memset_thread[i].numpages * hpagesize;
496 qemu_mutex_lock(&page_mutex);
497 threads_created_flag = true;
498 qemu_cond_broadcast(&page_cond);
499 qemu_mutex_unlock(&page_mutex);
501 for (i = 0; i < memset_num_threads; i++) {
502 qemu_thread_join(&memset_thread[i].pgthread);
504 g_free(memset_thread);
505 memset_thread = NULL;
507 return memset_thread_failed;
510 void os_mem_prealloc(int fd, char *area, size_t memory, int smp_cpus,
511 Error **errp)
513 int ret;
514 struct sigaction act, oldact;
515 size_t hpagesize = qemu_fd_getpagesize(fd);
516 size_t numpages = DIV_ROUND_UP(memory, hpagesize);
518 memset(&act, 0, sizeof(act));
519 act.sa_handler = &sigbus_handler;
520 act.sa_flags = 0;
522 ret = sigaction(SIGBUS, &act, &oldact);
523 if (ret) {
524 error_setg_errno(errp, errno,
525 "os_mem_prealloc: failed to install signal handler");
526 return;
529 /* touch pages simultaneously */
530 if (touch_all_pages(area, hpagesize, numpages, smp_cpus)) {
531 error_setg(errp, "os_mem_prealloc: Insufficient free host memory "
532 "pages available to allocate guest RAM");
535 ret = sigaction(SIGBUS, &oldact, NULL);
536 if (ret) {
537 /* Terminate QEMU since it can't recover from error */
538 perror("os_mem_prealloc: failed to reinstall signal handler");
539 exit(1);
543 char *qemu_get_pid_name(pid_t pid)
545 char *name = NULL;
547 #if defined(__FreeBSD__)
548 /* BSDs don't have /proc, but they provide a nice substitute */
549 struct kinfo_proc *proc = kinfo_getproc(pid);
551 if (proc) {
552 name = g_strdup(proc->ki_comm);
553 free(proc);
555 #else
556 /* Assume a system with reasonable procfs */
557 char *pid_path;
558 size_t len;
560 pid_path = g_strdup_printf("/proc/%d/cmdline", pid);
561 g_file_get_contents(pid_path, &name, &len, NULL);
562 g_free(pid_path);
563 #endif
565 return name;
569 pid_t qemu_fork(Error **errp)
571 sigset_t oldmask, newmask;
572 struct sigaction sig_action;
573 int saved_errno;
574 pid_t pid;
577 * Need to block signals now, so that child process can safely
578 * kill off caller's signal handlers without a race.
580 sigfillset(&newmask);
581 if (pthread_sigmask(SIG_SETMASK, &newmask, &oldmask) != 0) {
582 error_setg_errno(errp, errno,
583 "cannot block signals");
584 return -1;
587 pid = fork();
588 saved_errno = errno;
590 if (pid < 0) {
591 /* attempt to restore signal mask, but ignore failure, to
592 * avoid obscuring the fork failure */
593 (void)pthread_sigmask(SIG_SETMASK, &oldmask, NULL);
594 error_setg_errno(errp, saved_errno,
595 "cannot fork child process");
596 errno = saved_errno;
597 return -1;
598 } else if (pid) {
599 /* parent process */
601 /* Restore our original signal mask now that the child is
602 * safely running. Only documented failures are EFAULT (not
603 * possible, since we are using just-grabbed mask) or EINVAL
604 * (not possible, since we are using correct arguments). */
605 (void)pthread_sigmask(SIG_SETMASK, &oldmask, NULL);
606 } else {
607 /* child process */
608 size_t i;
610 /* Clear out all signal handlers from parent so nothing
611 * unexpected can happen in our child once we unblock
612 * signals */
613 sig_action.sa_handler = SIG_DFL;
614 sig_action.sa_flags = 0;
615 sigemptyset(&sig_action.sa_mask);
617 for (i = 1; i < NSIG; i++) {
618 /* Only possible errors are EFAULT or EINVAL The former
619 * won't happen, the latter we expect, so no need to check
620 * return value */
621 (void)sigaction(i, &sig_action, NULL);
624 /* Unmask all signals in child, since we've no idea what the
625 * caller's done with their signal mask and don't want to
626 * propagate that to children */
627 sigemptyset(&newmask);
628 if (pthread_sigmask(SIG_SETMASK, &newmask, NULL) != 0) {
629 Error *local_err = NULL;
630 error_setg_errno(&local_err, errno,
631 "cannot unblock signals");
632 error_report_err(local_err);
633 _exit(1);
636 return pid;
639 void *qemu_alloc_stack(size_t *sz)
641 void *ptr, *guardpage;
642 int flags;
643 #ifdef CONFIG_DEBUG_STACK_USAGE
644 void *ptr2;
645 #endif
646 size_t pagesz = qemu_real_host_page_size;
647 #ifdef _SC_THREAD_STACK_MIN
648 /* avoid stacks smaller than _SC_THREAD_STACK_MIN */
649 long min_stack_sz = sysconf(_SC_THREAD_STACK_MIN);
650 *sz = MAX(MAX(min_stack_sz, 0), *sz);
651 #endif
652 /* adjust stack size to a multiple of the page size */
653 *sz = ROUND_UP(*sz, pagesz);
654 /* allocate one extra page for the guard page */
655 *sz += pagesz;
657 flags = MAP_PRIVATE | MAP_ANONYMOUS;
658 #if defined(MAP_STACK) && defined(__OpenBSD__)
659 /* Only enable MAP_STACK on OpenBSD. Other OS's such as
660 * Linux/FreeBSD/NetBSD have a flag with the same name
661 * but have differing functionality. OpenBSD will SEGV
662 * if it spots execution with a stack pointer pointing
663 * at memory that was not allocated with MAP_STACK.
665 flags |= MAP_STACK;
666 #endif
668 ptr = mmap(NULL, *sz, PROT_READ | PROT_WRITE, flags, -1, 0);
669 if (ptr == MAP_FAILED) {
670 perror("failed to allocate memory for stack");
671 abort();
674 #if defined(HOST_IA64)
675 /* separate register stack */
676 guardpage = ptr + (((*sz - pagesz) / 2) & ~pagesz);
677 #elif defined(HOST_HPPA)
678 /* stack grows up */
679 guardpage = ptr + *sz - pagesz;
680 #else
681 /* stack grows down */
682 guardpage = ptr;
683 #endif
684 if (mprotect(guardpage, pagesz, PROT_NONE) != 0) {
685 perror("failed to set up stack guard page");
686 abort();
689 #ifdef CONFIG_DEBUG_STACK_USAGE
690 for (ptr2 = ptr + pagesz; ptr2 < ptr + *sz; ptr2 += sizeof(uint32_t)) {
691 *(uint32_t *)ptr2 = 0xdeadbeaf;
693 #endif
695 return ptr;
698 #ifdef CONFIG_DEBUG_STACK_USAGE
699 static __thread unsigned int max_stack_usage;
700 #endif
702 void qemu_free_stack(void *stack, size_t sz)
704 #ifdef CONFIG_DEBUG_STACK_USAGE
705 unsigned int usage;
706 void *ptr;
708 for (ptr = stack + qemu_real_host_page_size; ptr < stack + sz;
709 ptr += sizeof(uint32_t)) {
710 if (*(uint32_t *)ptr != 0xdeadbeaf) {
711 break;
714 usage = sz - (uintptr_t) (ptr - stack);
715 if (usage > max_stack_usage) {
716 error_report("thread %d max stack usage increased from %u to %u",
717 qemu_get_thread_id(), max_stack_usage, usage);
718 max_stack_usage = usage;
720 #endif
722 munmap(stack, sz);
725 void sigaction_invoke(struct sigaction *action,
726 struct qemu_signalfd_siginfo *info)
728 siginfo_t si = {};
729 si.si_signo = info->ssi_signo;
730 si.si_errno = info->ssi_errno;
731 si.si_code = info->ssi_code;
733 /* Convert the minimal set of fields defined by POSIX.
734 * Positive si_code values are reserved for kernel-generated
735 * signals, where the valid siginfo fields are determined by
736 * the signal number. But according to POSIX, it is unspecified
737 * whether SI_USER and SI_QUEUE have values less than or equal to
738 * zero.
740 if (info->ssi_code == SI_USER || info->ssi_code == SI_QUEUE ||
741 info->ssi_code <= 0) {
742 /* SIGTERM, etc. */
743 si.si_pid = info->ssi_pid;
744 si.si_uid = info->ssi_uid;
745 } else if (info->ssi_signo == SIGILL || info->ssi_signo == SIGFPE ||
746 info->ssi_signo == SIGSEGV || info->ssi_signo == SIGBUS) {
747 si.si_addr = (void *)(uintptr_t)info->ssi_addr;
748 } else if (info->ssi_signo == SIGCHLD) {
749 si.si_pid = info->ssi_pid;
750 si.si_status = info->ssi_status;
751 si.si_uid = info->ssi_uid;
753 action->sa_sigaction(info->ssi_signo, &si, NULL);