added OS dependent functions (temporary as most functions are generic in fact)
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@624 c046a42c-6fe2-441c-8c8c-71466251a162
This commit is contained in:
bellard
parent
58fe2f10f0
commit
ea88812f4f
460
osdep.c
Normal file
460
osdep.c
Normal file
@ -0,0 +1,460 @@
|
||||
/*
|
||||
* 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 <sys/mman.h>
|
||||
#include <sys/ipc.h>
|
||||
#include <errno.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include "cpu.h"
|
||||
|
||||
#if defined(__i386__) && !defined(CONFIG_SOFTMMU) && !defined(CONFIG_USER_ONLY)
|
||||
|
||||
/* 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;
|
||||
|
||||
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
|
||||
|
||||
/****************************************************************/
|
||||
/* 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);
|
||||
}
|
||||
|
||||
25
osdep.h
Normal file
25
osdep.h
Normal file
@ -0,0 +1,25 @@
|
||||
#ifndef QEMU_OSDEP_H
|
||||
#define QEMU_OSDEP_H
|
||||
|
||||
#include <stdarg.h>
|
||||
|
||||
int qemu_vsnprintf(char *buf, int buflen, const char *fmt, va_list args);
|
||||
void qemu_vprintf(const char *fmt, va_list ap);
|
||||
void qemu_printf(const char *fmt, ...);
|
||||
|
||||
void *qemu_malloc(size_t size);
|
||||
void qemu_free(void *ptr);
|
||||
|
||||
void *get_mmap_addr(unsigned long size);
|
||||
|
||||
/* specific kludges for OS compatibility (should be moved elsewhere) */
|
||||
#if defined(__i386__) && !defined(CONFIG_SOFTMMU) && !defined(CONFIG_USER_ONLY)
|
||||
|
||||
/* disabled pthread version of longjmp which prevent us from using an
|
||||
alternative signal stack */
|
||||
extern void __longjmp(jmp_buf env, int val);
|
||||
#define longjmp __longjmp
|
||||
|
||||
#endif
|
||||
|
||||
#endif
|
||||
Loading…
Reference in New Issue
Block a user