/*
* 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(__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);
}
#elif defined(USE_KQEMU)
#include <sys/vfs.h>
#include <sys/mman.h>
#include <fcntl.h>
void *qemu_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");
}
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 qemu_vfree(void *ptr)
{
/* may be useful some day, but currently we do not need to free */
}
#else
/* alloc shared memory pages */
void *qemu_vmalloc(size_t size)
{
#ifdef _BSD
return valloc(size);
#else
return memalign(4096, size);
#endif
}
void qemu_vfree(void *ptr)
{
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);
}
