[qemu.git] / arm-semi.c

/*
 *  Arm "Angel" semihosting syscalls
 *
 *  Copyright (c) 2005, 2007 CodeSourcery.
 *  Written by Paul Brook.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, see <http://www.gnu.org/licenses/>.
 */

#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>
#include <time.h>

#include "cpu.h"
#ifdef CONFIG_USER_ONLY
#include "qemu.h"

#define ARM_ANGEL_HEAP_SIZE (128 * 1024 * 1024)
#else
#include "qemu-common.h"
#include "gdbstub.h"
#endif

#define SYS_OPEN        0x01
#define SYS_CLOSE       0x02
#define SYS_WRITEC      0x03
#define SYS_WRITE0      0x04
#define SYS_WRITE       0x05
#define SYS_READ        0x06
#define SYS_READC       0x07
#define SYS_ISTTY       0x09
#define SYS_SEEK        0x0a
#define SYS_FLEN        0x0c
#define SYS_TMPNAM      0x0d
#define SYS_REMOVE      0x0e
#define SYS_RENAME      0x0f
#define SYS_CLOCK       0x10
#define SYS_TIME        0x11
#define SYS_SYSTEM      0x12
#define SYS_ERRNO       0x13
#define SYS_GET_CMDLINE 0x15
#define SYS_HEAPINFO    0x16
#define SYS_EXIT        0x18

#ifndef O_BINARY
#define O_BINARY 0
#endif

#define GDB_O_RDONLY  0x000
#define GDB_O_WRONLY  0x001
#define GDB_O_RDWR    0x002
#define GDB_O_APPEND  0x008
#define GDB_O_CREAT   0x200
#define GDB_O_TRUNC   0x400
#define GDB_O_BINARY  0

static int gdb_open_modeflags[12] = {
    GDB_O_RDONLY,
    GDB_O_RDONLY | GDB_O_BINARY,
    GDB_O_RDWR,
    GDB_O_RDWR | GDB_O_BINARY,
    GDB_O_WRONLY | GDB_O_CREAT | GDB_O_TRUNC,
    GDB_O_WRONLY | GDB_O_CREAT | GDB_O_TRUNC | GDB_O_BINARY,
    GDB_O_RDWR | GDB_O_CREAT | GDB_O_TRUNC,
    GDB_O_RDWR | GDB_O_CREAT | GDB_O_TRUNC | GDB_O_BINARY,
    GDB_O_WRONLY | GDB_O_CREAT | GDB_O_APPEND,
    GDB_O_WRONLY | GDB_O_CREAT | GDB_O_APPEND | GDB_O_BINARY,
    GDB_O_RDWR | GDB_O_CREAT | GDB_O_APPEND,
    GDB_O_RDWR | GDB_O_CREAT | GDB_O_APPEND | GDB_O_BINARY
};

static int open_modeflags[12] = {
    O_RDONLY,
    O_RDONLY | O_BINARY,
    O_RDWR,
    O_RDWR | O_BINARY,
    O_WRONLY | O_CREAT | O_TRUNC,
    O_WRONLY | O_CREAT | O_TRUNC | O_BINARY,
    O_RDWR | O_CREAT | O_TRUNC,
    O_RDWR | O_CREAT | O_TRUNC | O_BINARY,
    O_WRONLY | O_CREAT | O_APPEND,
    O_WRONLY | O_CREAT | O_APPEND | O_BINARY,
    O_RDWR | O_CREAT | O_APPEND,
    O_RDWR | O_CREAT | O_APPEND | O_BINARY
};

#ifdef CONFIG_USER_ONLY
static inline uint32_t set_swi_errno(TaskState *ts, uint32_t code)
{
    if (code == (uint32_t)-1)
        ts->swi_errno = errno;
    return code;
}
#else
static inline uint32_t set_swi_errno(CPUState *env, uint32_t code)
{
    return code;
}

#include "softmmu-semi.h"
#endif

static target_ulong arm_semi_syscall_len;

#if !defined(CONFIG_USER_ONLY)
static target_ulong syscall_err;
#endif

static void arm_semi_cb(CPUState *env, target_ulong ret, target_ulong err)
{
#ifdef CONFIG_USER_ONLY
    TaskState *ts = env->opaque;
#endif

    if (ret == (target_ulong)-1) {
#ifdef CONFIG_USER_ONLY
        ts->swi_errno = err;
#else
	syscall_err = err;
#endif
        env->regs[0] = ret;
    } else {
        /* Fixup syscalls that use nonstardard return conventions.  */
        switch (env->regs[0]) {
        case SYS_WRITE:
        case SYS_READ:
            env->regs[0] = arm_semi_syscall_len - ret;
            break;
        case SYS_SEEK:
            env->regs[0] = 0;
            break;
        default:
            env->regs[0] = ret;
            break;
        }
    }
}

static void arm_semi_flen_cb(CPUState *env, target_ulong ret, target_ulong err)
{
    /* The size is always stored in big-endian order, extract
       the value. We assume the size always fit in 32 bits.  */
    uint32_t size;
    cpu_memory_rw_debug(env, env->regs[13]-64+32, (uint8_t *)&size, 4, 0);
    env->regs[0] = be32_to_cpu(size);
#ifdef CONFIG_USER_ONLY
    ((TaskState *)env->opaque)->swi_errno = err;
#else
    syscall_err = err;
#endif
}

#define ARG(n)					\
({						\
    target_ulong __arg;				\
    /* FIXME - handle get_user() failure */	\
    get_user_ual(__arg, args + (n) * 4);	\
    __arg;					\
})
#define SET_ARG(n, val) put_user_ual(val, args + (n) * 4)
uint32_t do_arm_semihosting(CPUState *env)
{
    target_ulong args;
    char * s;
    int nr;
    uint32_t ret;
    uint32_t len;
#ifdef CONFIG_USER_ONLY
    TaskState *ts = env->opaque;
#else
    CPUState *ts = env;
#endif

    nr = env->regs[0];
    args = env->regs[1];
    switch (nr) {
    case SYS_OPEN:
        if (!(s = lock_user_string(ARG(0))))
            /* FIXME - should this error code be -TARGET_EFAULT ? */
            return (uint32_t)-1;
        if (ARG(1) >= 12)
            return (uint32_t)-1;
        if (strcmp(s, ":tt") == 0) {
            if (ARG(1) < 4)
                return STDIN_FILENO;
            else
                return STDOUT_FILENO;
        }
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "open,%s,%x,1a4", ARG(0),
			   (int)ARG(2)+1, gdb_open_modeflags[ARG(1)]);
            return env->regs[0];
        } else {
            ret = set_swi_errno(ts, open(s, open_modeflags[ARG(1)], 0644));
        }
        unlock_user(s, ARG(0), 0);
        return ret;
    case SYS_CLOSE:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "close,%x", ARG(0));
            return env->regs[0];
        } else {
            return set_swi_errno(ts, close(ARG(0)));
        }
    case SYS_WRITEC:
        {
          char c;

          if (get_user_u8(c, args))
              /* FIXME - should this error code be -TARGET_EFAULT ? */
              return (uint32_t)-1;
          /* Write to debug console.  stderr is near enough.  */
          if (use_gdb_syscalls()) {
                gdb_do_syscall(arm_semi_cb, "write,2,%x,1", args);
                return env->regs[0];
          } else {
                return write(STDERR_FILENO, &c, 1);
          }
        }
    case SYS_WRITE0:
        if (!(s = lock_user_string(args)))
            /* FIXME - should this error code be -TARGET_EFAULT ? */
            return (uint32_t)-1;
        len = strlen(s);
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "write,2,%x,%x\n", args, len);
            ret = env->regs[0];
        } else {
            ret = write(STDERR_FILENO, s, len);
        }
        unlock_user(s, args, 0);
        return ret;
    case SYS_WRITE:
        len = ARG(2);
        if (use_gdb_syscalls()) {
            arm_semi_syscall_len = len;
            gdb_do_syscall(arm_semi_cb, "write,%x,%x,%x", ARG(0), ARG(1), len);
            return env->regs[0];
        } else {
            if (!(s = lock_user(VERIFY_READ, ARG(1), len, 1)))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            ret = set_swi_errno(ts, write(ARG(0), s, len));
            unlock_user(s, ARG(1), 0);
            if (ret == (uint32_t)-1)
                return -1;
            return len - ret;
        }
    case SYS_READ:
        len = ARG(2);
        if (use_gdb_syscalls()) {
            arm_semi_syscall_len = len;
            gdb_do_syscall(arm_semi_cb, "read,%x,%x,%x", ARG(0), ARG(1), len);
            return env->regs[0];
        } else {
            if (!(s = lock_user(VERIFY_WRITE, ARG(1), len, 0)))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            do
              ret = set_swi_errno(ts, read(ARG(0), s, len));
            while (ret == -1 && errno == EINTR);
            unlock_user(s, ARG(1), len);
            if (ret == (uint32_t)-1)
                return -1;
            return len - ret;
        }
    case SYS_READC:
       /* XXX: Read from debug cosole. Not implemented.  */
        return 0;
    case SYS_ISTTY:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "isatty,%x", ARG(0));
            return env->regs[0];
        } else {
            return isatty(ARG(0));
        }
    case SYS_SEEK:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "lseek,%x,%x,0", ARG(0), ARG(1));
            return env->regs[0];
        } else {
            ret = set_swi_errno(ts, lseek(ARG(0), ARG(1), SEEK_SET));
            if (ret == (uint32_t)-1)
              return -1;
            return 0;
        }
    case SYS_FLEN:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_flen_cb, "fstat,%x,%x",
			   ARG(0), env->regs[13]-64);
            return env->regs[0];
        } else {
            struct stat buf;
            ret = set_swi_errno(ts, fstat(ARG(0), &buf));
            if (ret == (uint32_t)-1)
                return -1;
            return buf.st_size;
        }
    case SYS_TMPNAM:
        /* XXX: Not implemented.  */
        return -1;
    case SYS_REMOVE:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "unlink,%s", ARG(0), (int)ARG(1)+1);
            ret = env->regs[0];
        } else {
            if (!(s = lock_user_string(ARG(0))))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            ret =  set_swi_errno(ts, remove(s));
            unlock_user(s, ARG(0), 0);
        }
        return ret;
    case SYS_RENAME:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "rename,%s,%s",
                           ARG(0), (int)ARG(1)+1, ARG(2), (int)ARG(3)+1);
            return env->regs[0];
        } else {
            char *s2;
            s = lock_user_string(ARG(0));
            s2 = lock_user_string(ARG(2));
            if (!s || !s2)
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                ret = (uint32_t)-1;
            else
                ret = set_swi_errno(ts, rename(s, s2));
            if (s2)
                unlock_user(s2, ARG(2), 0);
            if (s)
                unlock_user(s, ARG(0), 0);
            return ret;
        }
    case SYS_CLOCK:
        return clock() / (CLOCKS_PER_SEC / 100);
    case SYS_TIME:
        return set_swi_errno(ts, time(NULL));
    case SYS_SYSTEM:
        if (use_gdb_syscalls()) {
            gdb_do_syscall(arm_semi_cb, "system,%s", ARG(0), (int)ARG(1)+1);
            return env->regs[0];
        } else {
            if (!(s = lock_user_string(ARG(0))))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            ret = set_swi_errno(ts, system(s));
            unlock_user(s, ARG(0), 0);
            return ret;
        }
    case SYS_ERRNO:
#ifdef CONFIG_USER_ONLY
        return ts->swi_errno;
#else
        return syscall_err;
#endif
    case SYS_GET_CMDLINE:
#ifdef CONFIG_USER_ONLY
        /* Build a commandline from the original argv.  */
        {
            char *arm_cmdline_buffer;
            const char *host_cmdline_buffer;

            unsigned int i;
            unsigned int arm_cmdline_len = ARG(1);
            unsigned int host_cmdline_len =
                ts->info->arg_end-ts->info->arg_start;

            if (!arm_cmdline_len || host_cmdline_len > arm_cmdline_len) {
                return -1; /* not enough space to store command line */
            }

            if (!host_cmdline_len) {
                /* We special-case the "empty command line" case (argc==0).
                   Just provide the terminating 0. */
                arm_cmdline_buffer = lock_user(VERIFY_WRITE, ARG(0), 1, 0);
                arm_cmdline_buffer[0] = 0;
                unlock_user(arm_cmdline_buffer, ARG(0), 1);

                /* Adjust the commandline length argument. */
                SET_ARG(1, 0);
                return 0;
            }

            /* lock the buffers on the ARM side */
            arm_cmdline_buffer =
                lock_user(VERIFY_WRITE, ARG(0), host_cmdline_len, 0);
            host_cmdline_buffer =
                lock_user(VERIFY_READ, ts->info->arg_start,
                                       host_cmdline_len, 1);

            if (arm_cmdline_buffer && host_cmdline_buffer)
            {
                /* the last argument is zero-terminated;
                   no need for additional termination */
                memcpy(arm_cmdline_buffer, host_cmdline_buffer,
                       host_cmdline_len);

                /* separate arguments by white spaces */
                for (i = 0; i < host_cmdline_len-1; i++) {
                    if (arm_cmdline_buffer[i] == 0) {
                        arm_cmdline_buffer[i] = ' ';
                    }
                }

                /* Adjust the commandline length argument. */
                SET_ARG(1, host_cmdline_len-1);
            }

            /* Unlock the buffers on the ARM side.  */
            unlock_user(arm_cmdline_buffer, ARG(0), host_cmdline_len);
            unlock_user((void*)host_cmdline_buffer, ts->info->arg_start, 0);

            /* Return success if we could return a commandline.  */
            return (arm_cmdline_buffer && host_cmdline_buffer) ? 0 : -1;
        }
#else
        return -1;
#endif
    case SYS_HEAPINFO:
        {
            uint32_t *ptr;
            uint32_t limit;

#ifdef CONFIG_USER_ONLY
            /* Some C libraries assume the heap immediately follows .bss, so
               allocate it using sbrk.  */
            if (!ts->heap_limit) {
                abi_ulong ret;

                ts->heap_base = do_brk(0);
                limit = ts->heap_base + ARM_ANGEL_HEAP_SIZE;
                /* Try a big heap, and reduce the size if that fails.  */
                for (;;) {
                    ret = do_brk(limit);
                    if (ret >= limit) {
                        break;
                    }
                    limit = (ts->heap_base >> 1) + (limit >> 1);
                }
                ts->heap_limit = limit;
            }

            if (!(ptr = lock_user(VERIFY_WRITE, ARG(0), 16, 0)))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            ptr[0] = tswap32(ts->heap_base);
            ptr[1] = tswap32(ts->heap_limit);
            ptr[2] = tswap32(ts->stack_base);
            ptr[3] = tswap32(0); /* Stack limit.  */
            unlock_user(ptr, ARG(0), 16);
#else
            limit = ram_size;
            if (!(ptr = lock_user(VERIFY_WRITE, ARG(0), 16, 0)))
                /* FIXME - should this error code be -TARGET_EFAULT ? */
                return (uint32_t)-1;
            /* TODO: Make this use the limit of the loaded application.  */
            ptr[0] = tswap32(limit / 2);
            ptr[1] = tswap32(limit);
            ptr[2] = tswap32(limit); /* Stack base */
            ptr[3] = tswap32(0); /* Stack limit.  */
            unlock_user(ptr, ARG(0), 16);
#endif
            return 0;
        }
    case SYS_EXIT:
        gdb_exit(env, 0);
        exit(0);
    default:
        fprintf(stderr, "qemu: Unsupported SemiHosting SWI 0x%02x\n", nr);
        cpu_dump_state(env, stderr, fprintf, 0);
        abort();
    }
}
Commit	Line	Data
a4f81979 FB	1	/*
a4f81979 FB	2	* Arm "Angel" semihosting syscalls
5fafdf24	3	*
8e71621f PB	4	* Copyright (c) 2005, 2007 CodeSourcery.
8e71621f PB	5	* Written by Paul Brook.
a4f81979 FB	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
8167ee88	18	* along with this program; if not, see <http://www.gnu.org/licenses/>.
a4f81979 FB	19	*/
	20
	21	#include <sys/types.h>
	22	#include <sys/stat.h>
	23	#include <fcntl.h>
	24	#include <unistd.h>
	25	#include <stdlib.h>
	26	#include <stdio.h>
	27	#include <time.h>
	28
8e71621f PB	29	#include "cpu.h"
8e71621f PB	30	#ifdef CONFIG_USER_ONLY
a4f81979 FB	31	#include "qemu.h"
	32
	33	#define ARM_ANGEL_HEAP_SIZE (128 * 1024 * 1024)
8e71621f	34	#else
87ecb68b	35	#include "qemu-common.h"
87ecb68b	36	#include "gdbstub.h"
8e71621f	37	#endif
a4f81979 FB	38
	39	#define SYS_OPEN 0x01
	40	#define SYS_CLOSE 0x02
	41	#define SYS_WRITEC 0x03
	42	#define SYS_WRITE0 0x04
	43	#define SYS_WRITE 0x05
	44	#define SYS_READ 0x06
	45	#define SYS_READC 0x07
	46	#define SYS_ISTTY 0x09
	47	#define SYS_SEEK 0x0a
	48	#define SYS_FLEN 0x0c
	49	#define SYS_TMPNAM 0x0d
	50	#define SYS_REMOVE 0x0e
	51	#define SYS_RENAME 0x0f
	52	#define SYS_CLOCK 0x10
	53	#define SYS_TIME 0x11
	54	#define SYS_SYSTEM 0x12
	55	#define SYS_ERRNO 0x13
	56	#define SYS_GET_CMDLINE 0x15
	57	#define SYS_HEAPINFO 0x16
	58	#define SYS_EXIT 0x18
	59
	60	#ifndef O_BINARY
	61	#define O_BINARY 0
	62	#endif
	63
a2d1ebaf PB	64	#define GDB_O_RDONLY 0x000
	65	#define GDB_O_WRONLY 0x001
	66	#define GDB_O_RDWR 0x002
	67	#define GDB_O_APPEND 0x008
	68	#define GDB_O_CREAT 0x200
	69	#define GDB_O_TRUNC 0x400
	70	#define GDB_O_BINARY 0
	71
	72	static int gdb_open_modeflags[12] = {
	73	GDB_O_RDONLY,
	74	GDB_O_RDONLY \| GDB_O_BINARY,
	75	GDB_O_RDWR,
	76	GDB_O_RDWR \| GDB_O_BINARY,
	77	GDB_O_WRONLY \| GDB_O_CREAT \| GDB_O_TRUNC,
	78	GDB_O_WRONLY \| GDB_O_CREAT \| GDB_O_TRUNC \| GDB_O_BINARY,
	79	GDB_O_RDWR \| GDB_O_CREAT \| GDB_O_TRUNC,
	80	GDB_O_RDWR \| GDB_O_CREAT \| GDB_O_TRUNC \| GDB_O_BINARY,
	81	GDB_O_WRONLY \| GDB_O_CREAT \| GDB_O_APPEND,
	82	GDB_O_WRONLY \| GDB_O_CREAT \| GDB_O_APPEND \| GDB_O_BINARY,
	83	GDB_O_RDWR \| GDB_O_CREAT \| GDB_O_APPEND,
	84	GDB_O_RDWR \| GDB_O_CREAT \| GDB_O_APPEND \| GDB_O_BINARY
	85	};
	86
	87	static int open_modeflags[12] = {
a4f81979 FB	88	O_RDONLY,
	89	O_RDONLY \| O_BINARY,
	90	O_RDWR,
	91	O_RDWR \| O_BINARY,
	92	O_WRONLY \| O_CREAT \| O_TRUNC,
	93	O_WRONLY \| O_CREAT \| O_TRUNC \| O_BINARY,
	94	O_RDWR \| O_CREAT \| O_TRUNC,
	95	O_RDWR \| O_CREAT \| O_TRUNC \| O_BINARY,
	96	O_WRONLY \| O_CREAT \| O_APPEND,
	97	O_WRONLY \| O_CREAT \| O_APPEND \| O_BINARY,
	98	O_RDWR \| O_CREAT \| O_APPEND,
	99	O_RDWR \| O_CREAT \| O_APPEND \| O_BINARY
	100	};
	101
8e71621f	102	#ifdef CONFIG_USER_ONLY
a4f81979 FB	103	static inline uint32_t set_swi_errno(TaskState *ts, uint32_t code)
a4f81979 FB	104	{
8e71621f PB	105	if (code == (uint32_t)-1)
	106	ts->swi_errno = errno;
	107	return code;
	108	}
	109	#else
	110	static inline uint32_t set_swi_errno(CPUState *env, uint32_t code)
	111	{
	112	return code;
	113	}
	114
a87295e8	115	#include "softmmu-semi.h"
8e71621f	116	#endif
a4f81979	117
a2d1ebaf PB	118	static target_ulong arm_semi_syscall_len;
a2d1ebaf PB	119
33d9cc8a PB	120	#if !defined(CONFIG_USER_ONLY)
	121	static target_ulong syscall_err;
	122	#endif
	123
a2d1ebaf PB	124	static void arm_semi_cb(CPUState *env, target_ulong ret, target_ulong err)
	125	{
	126	#ifdef CONFIG_USER_ONLY
	127	TaskState *ts = env->opaque;
	128	#endif
33d9cc8a	129
a2d1ebaf PB	130	if (ret == (target_ulong)-1) {
	131	#ifdef CONFIG_USER_ONLY
	132	ts->swi_errno = err;
33d9cc8a PB	133	#else
33d9cc8a PB	134	syscall_err = err;
a2d1ebaf PB	135	#endif
	136	env->regs[0] = ret;
	137	} else {
	138	/* Fixup syscalls that use nonstardard return conventions. */
	139	switch (env->regs[0]) {
	140	case SYS_WRITE:
	141	case SYS_READ:
	142	env->regs[0] = arm_semi_syscall_len - ret;
	143	break;
	144	case SYS_SEEK:
	145	env->regs[0] = 0;
	146	break;
	147	default:
	148	env->regs[0] = ret;
	149	break;
	150	}
	151	}
	152	}
	153
33d9cc8a PB	154	static void arm_semi_flen_cb(CPUState *env, target_ulong ret, target_ulong err)
	155	{
	156	/* The size is always stored in big-endian order, extract
	157	the value. We assume the size always fit in 32 bits. */
	158	uint32_t size;
	159	cpu_memory_rw_debug(env, env->regs[13]-64+32, (uint8_t *)&size, 4, 0);
	160	env->regs[0] = be32_to_cpu(size);
	161	#ifdef CONFIG_USER_ONLY
	162	((TaskState *)env->opaque)->swi_errno = err;
	163	#else
	164	syscall_err = err;
	165	#endif
	166	}
	167
2f619698 FB	168	#define ARG(n) \
	169	({ \
	170	target_ulong __arg; \
	171	/* FIXME - handle get_user() failure */ \
	172	get_user_ual(__arg, args + (n) * 4); \
	173	__arg; \
	174	})
	175	#define SET_ARG(n, val) put_user_ual(val, args + (n) * 4)
a4f81979 FB	176	uint32_t do_arm_semihosting(CPUState *env)
a4f81979 FB	177	{
53a5960a	178	target_ulong args;
a4f81979 FB	179	char * s;
	180	int nr;
	181	uint32_t ret;
8e71621f PB	182	uint32_t len;
8e71621f PB	183	#ifdef CONFIG_USER_ONLY
a4f81979	184	TaskState *ts = env->opaque;
8e71621f PB	185	#else
	186	CPUState *ts = env;
	187	#endif
a4f81979 FB	188
a4f81979 FB	189	nr = env->regs[0];
53a5960a	190	args = env->regs[1];
a4f81979 FB	191	switch (nr) {
a4f81979 FB	192	case SYS_OPEN:
579a97f7 FB	193	if (!(s = lock_user_string(ARG(0))))
	194	/* FIXME - should this error code be -TARGET_EFAULT ? */
	195	return (uint32_t)-1;
a4f81979	196	if (ARG(1) >= 12)
579a97f7	197	return (uint32_t)-1;
a4f81979 FB	198	if (strcmp(s, ":tt") == 0) {
	199	if (ARG(1) < 4)
	200	return STDIN_FILENO;
	201	else
	202	return STDOUT_FILENO;
	203	}
a2d1ebaf	204	if (use_gdb_syscalls()) {
5fafdf24	205	gdb_do_syscall(arm_semi_cb, "open,%s,%x,1a4", ARG(0),
33d9cc8a	206	(int)ARG(2)+1, gdb_open_modeflags[ARG(1)]);
a2d1ebaf PB	207	return env->regs[0];
	208	} else {
	209	ret = set_swi_errno(ts, open(s, open_modeflags[ARG(1)], 0644));
	210	}
8e71621f PB	211	unlock_user(s, ARG(0), 0);
8e71621f PB	212	return ret;
a4f81979	213	case SYS_CLOSE:
a2d1ebaf PB	214	if (use_gdb_syscalls()) {
	215	gdb_do_syscall(arm_semi_cb, "close,%x", ARG(0));
	216	return env->regs[0];
	217	} else {
	218	return set_swi_errno(ts, close(ARG(0)));
	219	}
a4f81979	220	case SYS_WRITEC:
53a5960a	221	{
2f619698 FB	222	char c;
	223
	224	if (get_user_u8(c, args))
	225	/* FIXME - should this error code be -TARGET_EFAULT ? */
	226	return (uint32_t)-1;
53a5960a	227	/* Write to debug console. stderr is near enough. */
a2d1ebaf PB	228	if (use_gdb_syscalls()) {
	229	gdb_do_syscall(arm_semi_cb, "write,2,%x,1", args);
	230	return env->regs[0];
	231	} else {
	232	return write(STDERR_FILENO, &c, 1);
	233	}
53a5960a	234	}
a4f81979	235	case SYS_WRITE0:
579a97f7 FB	236	if (!(s = lock_user_string(args)))
	237	/* FIXME - should this error code be -TARGET_EFAULT ? */
	238	return (uint32_t)-1;
a2d1ebaf PB	239	len = strlen(s);
	240	if (use_gdb_syscalls()) {
	241	gdb_do_syscall(arm_semi_cb, "write,2,%x,%x\n", args, len);
	242	ret = env->regs[0];
	243	} else {
	244	ret = write(STDERR_FILENO, s, len);
	245	}
53a5960a PB	246	unlock_user(s, args, 0);
53a5960a PB	247	return ret;
a4f81979	248	case SYS_WRITE:
8e71621f	249	len = ARG(2);
a2d1ebaf PB	250	if (use_gdb_syscalls()) {
	251	arm_semi_syscall_len = len;
	252	gdb_do_syscall(arm_semi_cb, "write,%x,%x,%x", ARG(0), ARG(1), len);
	253	return env->regs[0];
	254	} else {
579a97f7 FB	255	if (!(s = lock_user(VERIFY_READ, ARG(1), len, 1)))
	256	/* FIXME - should this error code be -TARGET_EFAULT ? */
	257	return (uint32_t)-1;
a2d1ebaf PB	258	ret = set_swi_errno(ts, write(ARG(0), s, len));
	259	unlock_user(s, ARG(1), 0);
	260	if (ret == (uint32_t)-1)
	261	return -1;
	262	return len - ret;
	263	}
a4f81979	264	case SYS_READ:
8e71621f	265	len = ARG(2);
a2d1ebaf PB	266	if (use_gdb_syscalls()) {
	267	arm_semi_syscall_len = len;
	268	gdb_do_syscall(arm_semi_cb, "read,%x,%x,%x", ARG(0), ARG(1), len);
	269	return env->regs[0];
	270	} else {
579a97f7 FB	271	if (!(s = lock_user(VERIFY_WRITE, ARG(1), len, 0)))
	272	/* FIXME - should this error code be -TARGET_EFAULT ? */
	273	return (uint32_t)-1;
a2d1ebaf PB	274	do
	275	ret = set_swi_errno(ts, read(ARG(0), s, len));
	276	while (ret == -1 && errno == EINTR);
	277	unlock_user(s, ARG(1), len);
	278	if (ret == (uint32_t)-1)
	279	return -1;
	280	return len - ret;
	281	}
a4f81979 FB	282	case SYS_READC:
	283	/* XXX: Read from debug cosole. Not implemented. */
	284	return 0;
	285	case SYS_ISTTY:
a2d1ebaf PB	286	if (use_gdb_syscalls()) {
	287	gdb_do_syscall(arm_semi_cb, "isatty,%x", ARG(0));
	288	return env->regs[0];
	289	} else {
	290	return isatty(ARG(0));
	291	}
a4f81979	292	case SYS_SEEK:
a2d1ebaf	293	if (use_gdb_syscalls()) {
33d9cc8a	294	gdb_do_syscall(arm_semi_cb, "lseek,%x,%x,0", ARG(0), ARG(1));
a2d1ebaf PB	295	return env->regs[0];
	296	} else {
	297	ret = set_swi_errno(ts, lseek(ARG(0), ARG(1), SEEK_SET));
	298	if (ret == (uint32_t)-1)
	299	return -1;
	300	return 0;
	301	}
a4f81979	302	case SYS_FLEN:
a2d1ebaf	303	if (use_gdb_syscalls()) {
5fafdf24	304	gdb_do_syscall(arm_semi_flen_cb, "fstat,%x,%x",
33d9cc8a PB	305	ARG(0), env->regs[13]-64);
33d9cc8a PB	306	return env->regs[0];
a2d1ebaf	307	} else {
a4f81979 FB	308	struct stat buf;
	309	ret = set_swi_errno(ts, fstat(ARG(0), &buf));
	310	if (ret == (uint32_t)-1)
	311	return -1;
	312	return buf.st_size;
	313	}
	314	case SYS_TMPNAM:
	315	/* XXX: Not implemented. */
	316	return -1;
	317	case SYS_REMOVE:
a2d1ebaf	318	if (use_gdb_syscalls()) {
33d9cc8a	319	gdb_do_syscall(arm_semi_cb, "unlink,%s", ARG(0), (int)ARG(1)+1);
a2d1ebaf PB	320	ret = env->regs[0];
a2d1ebaf PB	321	} else {
579a97f7 FB	322	if (!(s = lock_user_string(ARG(0))))
	323	/* FIXME - should this error code be -TARGET_EFAULT ? */
	324	return (uint32_t)-1;
a2d1ebaf PB	325	ret = set_swi_errno(ts, remove(s));
	326	unlock_user(s, ARG(0), 0);
	327	}
8e71621f	328	return ret;
a4f81979	329	case SYS_RENAME:
a2d1ebaf PB	330	if (use_gdb_syscalls()) {
a2d1ebaf PB	331	gdb_do_syscall(arm_semi_cb, "rename,%s,%s",
33d9cc8a	332	ARG(0), (int)ARG(1)+1, ARG(2), (int)ARG(3)+1);
a2d1ebaf PB	333	return env->regs[0];
a2d1ebaf PB	334	} else {
8e71621f PB	335	char *s2;
	336	s = lock_user_string(ARG(0));
	337	s2 = lock_user_string(ARG(2));
579a97f7 FB	338	if (!s \|\| !s2)
	339	/* FIXME - should this error code be -TARGET_EFAULT ? */
	340	ret = (uint32_t)-1;
	341	else
	342	ret = set_swi_errno(ts, rename(s, s2));
	343	if (s2)
	344	unlock_user(s2, ARG(2), 0);
	345	if (s)
	346	unlock_user(s, ARG(0), 0);
8e71621f PB	347	return ret;
8e71621f PB	348	}
a4f81979 FB	349	case SYS_CLOCK:
	350	return clock() / (CLOCKS_PER_SEC / 100);
	351	case SYS_TIME:
	352	return set_swi_errno(ts, time(NULL));
	353	case SYS_SYSTEM:
a2d1ebaf	354	if (use_gdb_syscalls()) {
33d9cc8a	355	gdb_do_syscall(arm_semi_cb, "system,%s", ARG(0), (int)ARG(1)+1);
a2d1ebaf PB	356	return env->regs[0];
a2d1ebaf PB	357	} else {
579a97f7 FB	358	if (!(s = lock_user_string(ARG(0))))
	359	/* FIXME - should this error code be -TARGET_EFAULT ? */
	360	return (uint32_t)-1;
a2d1ebaf PB	361	ret = set_swi_errno(ts, system(s));
a2d1ebaf PB	362	unlock_user(s, ARG(0), 0);
a982b531	363	return ret;
a2d1ebaf	364	}
a4f81979	365	case SYS_ERRNO:
8e71621f	366	#ifdef CONFIG_USER_ONLY
a4f81979	367	return ts->swi_errno;
8e71621f	368	#else
33d9cc8a	369	return syscall_err;
8e71621f	370	#endif
a4f81979	371	case SYS_GET_CMDLINE:
8e71621f	372	#ifdef CONFIG_USER_ONLY
38d0662a PB	373	/* Build a commandline from the original argv. */
38d0662a PB	374	{
2e8785ac WS	375	char *arm_cmdline_buffer;
2e8785ac WS	376	const char *host_cmdline_buffer;
579a97f7	377
2e8785ac WS	378	unsigned int i;
	379	unsigned int arm_cmdline_len = ARG(1);
	380	unsigned int host_cmdline_len =
	381	ts->info->arg_end-ts->info->arg_start;
	382
	383	if (!arm_cmdline_len \|\| host_cmdline_len > arm_cmdline_len) {
	384	return -1; /* not enough space to store command line */
	385	}
38d0662a	386
2e8785ac WS	387	if (!host_cmdline_len) {
	388	/* We special-case the "empty command line" case (argc==0).
	389	Just provide the terminating 0. */
	390	arm_cmdline_buffer = lock_user(VERIFY_WRITE, ARG(0), 1, 0);
	391	arm_cmdline_buffer[0] = 0;
	392	unlock_user(arm_cmdline_buffer, ARG(0), 1);
38d0662a	393
2e8785ac WS	394	/* Adjust the commandline length argument. */
	395	SET_ARG(1, 0);
	396	return 0;
38d0662a	397	}
38d0662a	398
2e8785ac WS	399	/* lock the buffers on the ARM side */
	400	arm_cmdline_buffer =
	401	lock_user(VERIFY_WRITE, ARG(0), host_cmdline_len, 0);
	402	host_cmdline_buffer =
	403	lock_user(VERIFY_READ, ts->info->arg_start,
	404	host_cmdline_len, 1);
38d0662a	405
2e8785ac WS	406	if (arm_cmdline_buffer && host_cmdline_buffer)
	407	{
	408	/* the last argument is zero-terminated;
	409	no need for additional termination */
	410	memcpy(arm_cmdline_buffer, host_cmdline_buffer,
	411	host_cmdline_len);
38d0662a	412
2e8785ac WS	413	/* separate arguments by white spaces */
	414	for (i = 0; i < host_cmdline_len-1; i++) {
	415	if (arm_cmdline_buffer[i] == 0) {
	416	arm_cmdline_buffer[i] = ' ';
	417	}
	418	}
	419
	420	/* Adjust the commandline length argument. */
	421	SET_ARG(1, host_cmdline_len-1);
	422	}
	423
	424	/* Unlock the buffers on the ARM side. */
	425	unlock_user(arm_cmdline_buffer, ARG(0), host_cmdline_len);
	426	unlock_user((void*)host_cmdline_buffer, ts->info->arg_start, 0);
	427
	428	/* Return success if we could return a commandline. */
	429	return (arm_cmdline_buffer && host_cmdline_buffer) ? 0 : -1;
38d0662a	430	}
8e71621f	431	#else
2e8785ac	432	return -1;
8e71621f	433	#endif
a4f81979 FB	434	case SYS_HEAPINFO:
	435	{
	436	uint32_t *ptr;
	437	uint32_t limit;
	438
8e71621f PB	439	#ifdef CONFIG_USER_ONLY
8e71621f PB	440	/* Some C libraries assume the heap immediately follows .bss, so
a4f81979 FB	441	allocate it using sbrk. */
a4f81979 FB	442	if (!ts->heap_limit) {
206ae74a	443	abi_ulong ret;
a4f81979	444
53a5960a	445	ts->heap_base = do_brk(0);
a4f81979 FB	446	limit = ts->heap_base + ARM_ANGEL_HEAP_SIZE;
	447	/* Try a big heap, and reduce the size if that fails. */
	448	for (;;) {
53a5960a	449	ret = do_brk(limit);
206ae74a	450	if (ret >= limit) {
a4f81979	451	break;
206ae74a	452	}
a4f81979 FB	453	limit = (ts->heap_base >> 1) + (limit >> 1);
	454	}
	455	ts->heap_limit = limit;
	456	}
3b46e624	457
579a97f7 FB	458	if (!(ptr = lock_user(VERIFY_WRITE, ARG(0), 16, 0)))
	459	/* FIXME - should this error code be -TARGET_EFAULT ? */
	460	return (uint32_t)-1;
a4f81979 FB	461	ptr[0] = tswap32(ts->heap_base);
	462	ptr[1] = tswap32(ts->heap_limit);
	463	ptr[2] = tswap32(ts->stack_base);
	464	ptr[3] = tswap32(0); /* Stack limit. */
8e71621f PB	465	unlock_user(ptr, ARG(0), 16);
	466	#else
	467	limit = ram_size;
579a97f7 FB	468	if (!(ptr = lock_user(VERIFY_WRITE, ARG(0), 16, 0)))
	469	/* FIXME - should this error code be -TARGET_EFAULT ? */
	470	return (uint32_t)-1;
8e71621f PB	471	/* TODO: Make this use the limit of the loaded application. */
	472	ptr[0] = tswap32(limit / 2);
	473	ptr[1] = tswap32(limit);
	474	ptr[2] = tswap32(limit); /* Stack base */
	475	ptr[3] = tswap32(0); /* Stack limit. */
	476	unlock_user(ptr, ARG(0), 16);
	477	#endif
a4f81979 FB	478	return 0;
	479	}
	480	case SYS_EXIT:
0e1c9c54	481	gdb_exit(env, 0);
a4f81979 FB	482	exit(0);
	483	default:
	484	fprintf(stderr, "qemu: Unsupported SemiHosting SWI 0x%02x\n", nr);
	485	cpu_dump_state(env, stderr, fprintf, 0);
	486	abort();
	487	}
	488	}