Archipelago » qemu

/*

 * 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;

}

/****************************************************************/

/* 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

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);

}

#endif

void *qemu_mallocz(size_t size)

{

    void *ptr;

    ptr = qemu_malloc(size);

    if (!ptr)

        return NULL;

    memset(ptr, 0, size);

    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);

}