| /* |
| * QEMU low level functions |
| * |
| * Copyright (c) 2003 Fabrice Bellard |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy |
| * of this software and associated documentation files (the "Software"), to deal |
| * in the Software without restriction, including without limitation the rights |
| * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| * copies of the Software, and to permit persons to whom the Software is |
| * furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| * THE SOFTWARE. |
| */ |
| #include <stdlib.h> |
| #include <stdio.h> |
| #include <stdarg.h> |
| #include <string.h> |
| #include <errno.h> |
| #include <unistd.h> |
| |
| #include "cpu.h" |
| #if defined(USE_KQEMU) |
| #include "vl.h" |
| #endif |
| |
| #if defined(__i386__) && !defined(CONFIG_SOFTMMU) && !defined(CONFIG_USER_ONLY) |
| |
| #include <sys/mman.h> |
| #include <sys/ipc.h> |
| |
| /* When not using soft mmu, libc independant functions are needed for |
| the CPU core because it needs to use alternates stacks and |
| libc/thread incompatibles settings */ |
| |
| #include <linux/unistd.h> |
| |
| #define QEMU_SYSCALL0(name) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name)); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL1(name,arg1) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name),"b" ((long)(arg1))); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL2(name,arg1,arg2) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name),"b" ((long)(arg1)),"c" ((long)(arg2))); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL3(name,arg1,arg2,arg3) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name),"b" ((long)(arg1)),"c" ((long)(arg2)), \ |
| "d" ((long)(arg3))); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL4(name,arg1,arg2,arg3,arg4) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name),"b" ((long)(arg1)),"c" ((long)(arg2)), \ |
| "d" ((long)(arg3)),"S" ((long)(arg4))); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL5(name,arg1,arg2,arg3,arg4,arg5) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("int $0x80" \ |
| : "=a" (__res) \ |
| : "0" (__NR_##name),"b" ((long)(arg1)),"c" ((long)(arg2)), \ |
| "d" ((long)(arg3)),"S" ((long)(arg4)),"D" ((long)(arg5))); \ |
| return __res; \ |
| } |
| |
| #define QEMU_SYSCALL6(name,arg1,arg2,arg3,arg4,arg5,arg6) \ |
| { \ |
| long __res; \ |
| __asm__ volatile ("push %%ebp ; movl %%eax,%%ebp ; movl %1,%%eax ; int $0x80 ; pop %%ebp" \ |
| : "=a" (__res) \ |
| : "i" (__NR_##name),"b" ((long)(arg1)),"c" ((long)(arg2)), \ |
| "d" ((long)(arg3)),"S" ((long)(arg4)),"D" ((long)(arg5)), \ |
| "0" ((long)(arg6))); \ |
| return __res; \ |
| } |
| |
| int qemu_write(int fd, const void *buf, size_t n) |
| { |
| QEMU_SYSCALL3(write, fd, buf, n); |
| } |
| |
| |
| |
| /****************************************************************/ |
| /* shmat replacement */ |
| |
| int qemu_ipc(int call, unsigned long first, |
| unsigned long second, unsigned long third, |
| void *ptr, unsigned long fifth) |
| { |
| QEMU_SYSCALL6(ipc, call, first, second, third, ptr, fifth); |
| } |
| |
| #define SHMAT 21 |
| |
| /* we must define shmat so that a specific address will be used when |
| mapping the X11 ximage */ |
| void *shmat(int shmid, const void *shmaddr, int shmflg) |
| { |
| void *ptr; |
| int ret; |
| /* we give an address in the right memory area */ |
| if (!shmaddr) |
| shmaddr = get_mmap_addr(8192 * 1024); |
| ret = qemu_ipc(SHMAT, shmid, shmflg, (unsigned long)&ptr, (void *)shmaddr, 0); |
| if (ret < 0) |
| return NULL; |
| return ptr; |
| } |
| |
| /****************************************************************/ |
| /* sigaction bypassing the threads */ |
| |
| static int kernel_sigaction(int signum, const struct qemu_sigaction *act, |
| struct qemu_sigaction *oldact, |
| int sigsetsize) |
| { |
| QEMU_SYSCALL4(rt_sigaction, signum, act, oldact, sigsetsize); |
| } |
| |
| int qemu_sigaction(int signum, const struct qemu_sigaction *act, |
| struct qemu_sigaction *oldact) |
| { |
| return kernel_sigaction(signum, act, oldact, 8); |
| } |
| |
| /****************************************************************/ |
| /* memory allocation */ |
| |
| //#define DEBUG_MALLOC |
| |
| #define MALLOC_BASE 0xab000000 |
| #define PHYS_RAM_BASE 0xac000000 |
| |
| #define MALLOC_ALIGN 16 |
| #define BLOCK_HEADER_SIZE 16 |
| |
| typedef struct MemoryBlock { |
| struct MemoryBlock *next; |
| unsigned long size; /* size of block, including header */ |
| } MemoryBlock; |
| |
| static MemoryBlock *first_free_block; |
| static unsigned long malloc_addr = MALLOC_BASE; |
| |
| static void *malloc_get_space(size_t size) |
| { |
| void *ptr; |
| size = TARGET_PAGE_ALIGN(size); |
| ptr = mmap((void *)malloc_addr, size, |
| PROT_WRITE | PROT_READ, |
| MAP_PRIVATE | MAP_FIXED | MAP_ANON, -1, 0); |
| if (ptr == MAP_FAILED) |
| return NULL; |
| malloc_addr += size; |
| return ptr; |
| } |
| |
| void *qemu_malloc(size_t size) |
| { |
| MemoryBlock *mb, *mb1, **pmb; |
| void *ptr; |
| size_t size1, area_size; |
| |
| if (size == 0) |
| return NULL; |
| |
| size = (size + BLOCK_HEADER_SIZE + MALLOC_ALIGN - 1) & ~(MALLOC_ALIGN - 1); |
| pmb = &first_free_block; |
| for(;;) { |
| mb = *pmb; |
| if (mb == NULL) |
| break; |
| if (size <= mb->size) |
| goto found; |
| pmb = &mb->next; |
| } |
| /* no big enough blocks found: get new space */ |
| area_size = TARGET_PAGE_ALIGN(size); |
| mb = malloc_get_space(area_size); |
| if (!mb) |
| return NULL; |
| size1 = area_size - size; |
| if (size1 > 0) { |
| /* create a new free block */ |
| mb1 = (MemoryBlock *)((uint8_t *)mb + size); |
| mb1->next = NULL; |
| mb1->size = size1; |
| *pmb = mb1; |
| } |
| goto the_end; |
| found: |
| /* a free block was found: use it */ |
| size1 = mb->size - size; |
| if (size1 > 0) { |
| /* create a new free block */ |
| mb1 = (MemoryBlock *)((uint8_t *)mb + size); |
| mb1->next = mb->next; |
| mb1->size = size1; |
| *pmb = mb1; |
| } else { |
| /* suppress the first block */ |
| *pmb = mb->next; |
| } |
| the_end: |
| mb->size = size; |
| mb->next = NULL; |
| ptr = ((uint8_t *)mb + BLOCK_HEADER_SIZE); |
| #ifdef DEBUG_MALLOC |
| qemu_printf("malloc: size=0x%x ptr=0x%lx\n", size, (unsigned long)ptr); |
| #endif |
| return ptr; |
| } |
| |
| void qemu_free(void *ptr) |
| { |
| MemoryBlock *mb; |
| |
| if (!ptr) |
| return; |
| mb = (MemoryBlock *)((uint8_t *)ptr - BLOCK_HEADER_SIZE); |
| mb->next = first_free_block; |
| first_free_block = mb; |
| } |
| |
| /****************************************************************/ |
| /* virtual memory allocation */ |
| |
| unsigned long mmap_addr = PHYS_RAM_BASE; |
| |
| void *get_mmap_addr(unsigned long size) |
| { |
| unsigned long addr; |
| addr = mmap_addr; |
| mmap_addr += ((size + 4095) & ~4095) + 4096; |
| return (void *)addr; |
| } |
| |
| #else |
| |
| #ifdef _WIN32 |
| #include <windows.h> |
| #elif defined(_BSD) |
| #include <stdlib.h> |
| #else |
| #include <malloc.h> |
| #endif |
| |
| int qemu_write(int fd, const void *buf, size_t n) |
| { |
| int ret; |
| ret = write(fd, buf, n); |
| if (ret < 0) |
| return -errno; |
| else |
| return ret; |
| } |
| |
| void *get_mmap_addr(unsigned long size) |
| { |
| return NULL; |
| } |
| |
| void qemu_free(void *ptr) |
| { |
| free(ptr); |
| } |
| |
| void *qemu_malloc(size_t size) |
| { |
| return malloc(size); |
| } |
| |
| #if defined(_WIN32) |
| |
| void *qemu_vmalloc(size_t size) |
| { |
| /* FIXME: this is not exactly optimal solution since VirtualAlloc |
| has 64Kb granularity, but at least it guarantees us that the |
| memory is page aligned. */ |
| return VirtualAlloc(NULL, size, MEM_COMMIT, PAGE_READWRITE); |
| } |
| |
| void qemu_vfree(void *ptr) |
| { |
| VirtualFree(ptr, 0, MEM_RELEASE); |
| } |
| |
| #else |
| |
| #if defined(USE_KQEMU) |
| |
| #include <sys/vfs.h> |
| #include <sys/mman.h> |
| #include <fcntl.h> |
| |
| void *kqemu_vmalloc(size_t size) |
| { |
| static int phys_ram_fd = -1; |
| static int phys_ram_size = 0; |
| const char *tmpdir; |
| char phys_ram_file[1024]; |
| void *ptr; |
| struct statfs stfs; |
| |
| if (phys_ram_fd < 0) { |
| tmpdir = getenv("QEMU_TMPDIR"); |
| if (!tmpdir) |
| tmpdir = "/dev/shm"; |
| if (statfs(tmpdir, &stfs) == 0) { |
| int64_t free_space; |
| int ram_mb; |
| |
| extern int ram_size; |
| free_space = (int64_t)stfs.f_bavail * stfs.f_bsize; |
| if ((ram_size + 8192 * 1024) >= free_space) { |
| ram_mb = (ram_size / (1024 * 1024)); |
| fprintf(stderr, |
| "You do not have enough space in '%s' for the %d MB of QEMU virtual RAM.\n", |
| tmpdir, ram_mb); |
| if (strcmp(tmpdir, "/dev/shm") == 0) { |
| fprintf(stderr, "To have more space available provided you have enough RAM and swap, do as root:\n" |
| "umount /dev/shm\n" |
| "mount -t tmpfs -o size=%dm none /dev/shm\n", |
| ram_mb + 16); |
| } else { |
| fprintf(stderr, |
| "Use the '-m' option of QEMU to diminish the amount of virtual RAM or use the\n" |
| "QEMU_TMPDIR environment variable to set another directory where the QEMU\n" |
| "temporary RAM file will be opened.\n"); |
| } |
| fprintf(stderr, "Or disable the accelerator module with -no-kqemu\n"); |
| exit(1); |
| } |
| } |
| snprintf(phys_ram_file, sizeof(phys_ram_file), "%s/qemuXXXXXX", |
| tmpdir); |
| if (mkstemp(phys_ram_file) < 0) { |
| fprintf(stderr, |
| "warning: could not create temporary file in '%s'.\n" |
| "Use QEMU_TMPDIR to select a directory in a tmpfs filesystem.\n" |
| "Using '/tmp' as fallback.\n", |
| tmpdir); |
| snprintf(phys_ram_file, sizeof(phys_ram_file), "%s/qemuXXXXXX", |
| "/tmp"); |
| if (mkstemp(phys_ram_file) < 0) { |
| fprintf(stderr, "Could not create temporary memory file '%s'\n", |
| phys_ram_file); |
| exit(1); |
| } |
| } |
| phys_ram_fd = open(phys_ram_file, O_CREAT | O_TRUNC | O_RDWR, 0600); |
| if (phys_ram_fd < 0) { |
| fprintf(stderr, "Could not open temporary memory file '%s'\n", |
| phys_ram_file); |
| exit(1); |
| } |
| unlink(phys_ram_file); |
| } |
| size = (size + 4095) & ~4095; |
| ftruncate(phys_ram_fd, phys_ram_size + size); |
| ptr = mmap(NULL, |
| size, |
| PROT_WRITE | PROT_READ, MAP_SHARED, |
| phys_ram_fd, phys_ram_size); |
| if (ptr == MAP_FAILED) { |
| fprintf(stderr, "Could not map physical memory\n"); |
| exit(1); |
| } |
| phys_ram_size += size; |
| return ptr; |
| } |
| |
| void kqemu_vfree(void *ptr) |
| { |
| /* may be useful some day, but currently we do not need to free */ |
| } |
| |
| #endif |
| |
| /* alloc shared memory pages */ |
| void *qemu_vmalloc(size_t size) |
| { |
| #if defined(USE_KQEMU) |
| if (kqemu_allowed) |
| return kqemu_vmalloc(size); |
| #endif |
| #ifdef _BSD |
| return valloc(size); |
| #else |
| return memalign(4096, size); |
| #endif |
| } |
| |
| void qemu_vfree(void *ptr) |
| { |
| #if defined(USE_KQEMU) |
| if (kqemu_allowed) |
| kqemu_vfree(ptr); |
| #endif |
| free(ptr); |
| } |
| |
| #endif |
| |
| #endif |
| |
| void *qemu_mallocz(size_t size) |
| { |
| void *ptr; |
| ptr = qemu_malloc(size); |
| if (!ptr) |
| return NULL; |
| memset(ptr, 0, size); |
| return ptr; |
| } |
| |
| char *qemu_strdup(const char *str) |
| { |
| char *ptr; |
| ptr = qemu_malloc(strlen(str) + 1); |
| if (!ptr) |
| return NULL; |
| strcpy(ptr, str); |
| return ptr; |
| } |
| |
| /****************************************************************/ |
| /* printf support */ |
| |
| static inline int qemu_isdigit(int c) |
| { |
| return c >= '0' && c <= '9'; |
| } |
| |
| #define OUTCHAR(c) (buflen > 0? (--buflen, *buf++ = (c)): 0) |
| |
| /* from BSD ppp sources */ |
| int qemu_vsnprintf(char *buf, int buflen, const char *fmt, va_list args) |
| { |
| int c, i, n; |
| int width, prec, fillch; |
| int base, len, neg; |
| unsigned long val = 0; |
| const char *f; |
| char *str, *buf0; |
| char num[32]; |
| static const char hexchars[] = "0123456789abcdef"; |
| |
| buf0 = buf; |
| --buflen; |
| while (buflen > 0) { |
| for (f = fmt; *f != '%' && *f != 0; ++f) |
| ; |
| if (f > fmt) { |
| len = f - fmt; |
| if (len > buflen) |
| len = buflen; |
| memcpy(buf, fmt, len); |
| buf += len; |
| buflen -= len; |
| fmt = f; |
| } |
| if (*fmt == 0) |
| break; |
| c = *++fmt; |
| width = prec = 0; |
| fillch = ' '; |
| if (c == '0') { |
| fillch = '0'; |
| c = *++fmt; |
| } |
| if (c == '*') { |
| width = va_arg(args, int); |
| c = *++fmt; |
| } else { |
| while (qemu_isdigit(c)) { |
| width = width * 10 + c - '0'; |
| c = *++fmt; |
| } |
| } |
| if (c == '.') { |
| c = *++fmt; |
| if (c == '*') { |
| prec = va_arg(args, int); |
| c = *++fmt; |
| } else { |
| while (qemu_isdigit(c)) { |
| prec = prec * 10 + c - '0'; |
| c = *++fmt; |
| } |
| } |
| } |
| /* modifiers */ |
| switch(c) { |
| case 'l': |
| c = *++fmt; |
| break; |
| default: |
| break; |
| } |
| str = 0; |
| base = 0; |
| neg = 0; |
| ++fmt; |
| switch (c) { |
| case 'd': |
| i = va_arg(args, int); |
| if (i < 0) { |
| neg = 1; |
| val = -i; |
| } else |
| val = i; |
| base = 10; |
| break; |
| case 'o': |
| val = va_arg(args, unsigned int); |
| base = 8; |
| break; |
| case 'x': |
| case 'X': |
| val = va_arg(args, unsigned int); |
| base = 16; |
| break; |
| case 'p': |
| val = (unsigned long) va_arg(args, void *); |
| base = 16; |
| neg = 2; |
| break; |
| case 's': |
| str = va_arg(args, char *); |
| break; |
| case 'c': |
| num[0] = va_arg(args, int); |
| num[1] = 0; |
| str = num; |
| break; |
| default: |
| *buf++ = '%'; |
| if (c != '%') |
| --fmt; /* so %z outputs %z etc. */ |
| --buflen; |
| continue; |
| } |
| if (base != 0) { |
| str = num + sizeof(num); |
| *--str = 0; |
| while (str > num + neg) { |
| *--str = hexchars[val % base]; |
| val = val / base; |
| if (--prec <= 0 && val == 0) |
| break; |
| } |
| switch (neg) { |
| case 1: |
| *--str = '-'; |
| break; |
| case 2: |
| *--str = 'x'; |
| *--str = '0'; |
| break; |
| } |
| len = num + sizeof(num) - 1 - str; |
| } else { |
| len = strlen(str); |
| if (prec > 0 && len > prec) |
| len = prec; |
| } |
| if (width > 0) { |
| if (width > buflen) |
| width = buflen; |
| if ((n = width - len) > 0) { |
| buflen -= n; |
| for (; n > 0; --n) |
| *buf++ = fillch; |
| } |
| } |
| if (len > buflen) |
| len = buflen; |
| memcpy(buf, str, len); |
| buf += len; |
| buflen -= len; |
| } |
| *buf = 0; |
| return buf - buf0; |
| } |
| |
| void qemu_vprintf(const char *fmt, va_list ap) |
| { |
| char buf[1024]; |
| int len; |
| |
| len = qemu_vsnprintf(buf, sizeof(buf), fmt, ap); |
| qemu_write(1, buf, len); |
| } |
| |
| void qemu_printf(const char *fmt, ...) |
| { |
| va_list ap; |
| va_start(ap, fmt); |
| qemu_vprintf(fmt, ap); |
| va_end(ap); |
| } |
| |