Archipelago » qemu

/*

 *  qemu user main

 * 

 *  Copyright (c) 2003 Fabrice Bellard

 *

 *  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, write to the Free Software

 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

 */

#include <stdlib.h>

#include <stdio.h>

#include <stdarg.h>

#include <string.h>

#include <errno.h>

#include <unistd.h>

#include "qemu.h"

#define DEBUG_LOGFILE "/tmp/qemu.log"

#ifdef __APPLE__

#include <crt_externs.h>

# define environ  (*_NSGetEnviron())

#endif

static const char *interp_prefix = CONFIG_QEMU_PREFIX;

#if defined(__i386__) && !defined(CONFIG_STATIC)

/* Force usage of an ELF interpreter even if it is an ELF shared

   object ! */

const char interp[] __attribute__((section(".interp"))) = "/lib/ld-linux.so.2";

#endif

/* for recent libc, we add these dummy symbols which are not declared

   when generating a linked object (bug in ld ?) */

#if (__GLIBC__ > 2 || (__GLIBC__ == 2 && __GLIBC_MINOR__ >= 3)) && !defined(CONFIG_STATIC)

long __preinit_array_start[0];

long __preinit_array_end[0];

long __init_array_start[0];

long __init_array_end[0];

long __fini_array_start[0];

long __fini_array_end[0];

#endif

/* XXX: on x86 MAP_GROWSDOWN only works if ESP <= address + 32, so

   we allocate a bigger stack. Need a better solution, for example

   by remapping the process stack directly at the right place */

unsigned long x86_stack_size = 512 * 1024;

void gemu_log(const char *fmt, ...)

{

    va_list ap;

    va_start(ap, fmt);

    vfprintf(stderr, fmt, ap);

    va_end(ap);

}

void cpu_outb(CPUState *env, int addr, int val)

{

    fprintf(stderr, "outb: port=0x%04x, data=%02x\n", addr, val);

}

void cpu_outw(CPUState *env, int addr, int val)

{

    fprintf(stderr, "outw: port=0x%04x, data=%04x\n", addr, val);

}

void cpu_outl(CPUState *env, int addr, int val)

{

    fprintf(stderr, "outl: port=0x%04x, data=%08x\n", addr, val);

}

int cpu_inb(CPUState *env, int addr)

{

    fprintf(stderr, "inb: port=0x%04x\n", addr);

    return 0;

}

int cpu_inw(CPUState *env, int addr)

{

    fprintf(stderr, "inw: port=0x%04x\n", addr);

    return 0;

}

int cpu_inl(CPUState *env, int addr)

{

    fprintf(stderr, "inl: port=0x%04x\n", addr);

    return 0;

}

int cpu_get_pic_interrupt(CPUState *env)

{

    return -1;

}

/* timers for rdtsc */

#if defined(__i386__)

int64_t cpu_get_real_ticks(void)

{

    int64_t val;

    asm volatile ("rdtsc" : "=A" (val));

    return val;

}

#elif defined(__x86_64__)

int64_t cpu_get_real_ticks(void)

{

    uint32_t low,high;

    int64_t val;

    asm volatile("rdtsc" : "=a" (low), "=d" (high));

    val = high;

    val <<= 32;

    val |= low;

    return val;

}

#else

static uint64_t emu_time;

int64_t cpu_get_real_ticks(void)

{

    return emu_time++;

}

#endif

#ifdef TARGET_I386

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

/* CPUX86 core interface */

uint64_t cpu_get_tsc(CPUX86State *env)

{

    return cpu_get_real_ticks();

}

static void write_dt(void *ptr, unsigned long addr, unsigned long limit, 

                     int flags)

{

    unsigned int e1, e2;

    e1 = (addr << 16) | (limit & 0xffff);

    e2 = ((addr >> 16) & 0xff) | (addr & 0xff000000) | (limit & 0x000f0000);

    e2 |= flags;

    stl((uint8_t *)ptr, e1);

    stl((uint8_t *)ptr + 4, e2);

}

static void set_gate(void *ptr, unsigned int type, unsigned int dpl, 

                     unsigned long addr, unsigned int sel)

{

    unsigned int e1, e2;

    e1 = (addr & 0xffff) | (sel << 16);

    e2 = (addr & 0xffff0000) | 0x8000 | (dpl << 13) | (type << 8);

    stl((uint8_t *)ptr, e1);

    stl((uint8_t *)ptr + 4, e2);

}

uint64_t gdt_table[6];

uint64_t idt_table[256];

/* only dpl matters as we do only user space emulation */

static void set_idt(int n, unsigned int dpl)

{

    set_gate(idt_table + n, 0, dpl, 0, 0);

}

void cpu_loop(CPUX86State *env)

{

    int trapnr;

    target_ulong pc;

    target_siginfo_t info;

    for(;;) {

        trapnr = cpu_x86_exec(env);

        switch(trapnr) {

        case 0x80:

            /* linux syscall */

            env->regs[R_EAX] = do_syscall(env, 

                                          env->regs[R_EAX], 

                                          env->regs[R_EBX],

                                          env->regs[R_ECX],

                                          env->regs[R_EDX],

                                          env->regs[R_ESI],

                                          env->regs[R_EDI],

                                          env->regs[R_EBP]);

            break;

        case EXCP0B_NOSEG:

        case EXCP0C_STACK:

            info.si_signo = SIGBUS;

            info.si_errno = 0;

            info.si_code = TARGET_SI_KERNEL;

            info._sifields._sigfault._addr = 0;

            queue_signal(info.si_signo, &info);

            break;

        case EXCP0D_GPF:

            if (env->eflags & VM_MASK) {

                handle_vm86_fault(env);

            } else {

                info.si_signo = SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SI_KERNEL;

                info._sifields._sigfault._addr = 0;

                queue_signal(info.si_signo, &info);

            }

            break;

        case EXCP0E_PAGE:

            info.si_signo = SIGSEGV;

            info.si_errno = 0;

            if (!(env->error_code & 1))

                info.si_code = TARGET_SEGV_MAPERR;

            else

                info.si_code = TARGET_SEGV_ACCERR;

            info._sifields._sigfault._addr = env->cr[2];

            queue_signal(info.si_signo, &info);

            break;

        case EXCP00_DIVZ:

            if (env->eflags & VM_MASK) {

                handle_vm86_trap(env, trapnr);

            } else {

                /* division by zero */

                info.si_signo = SIGFPE;

                info.si_errno = 0;

                info.si_code = TARGET_FPE_INTDIV;

                info._sifields._sigfault._addr = env->eip;

                queue_signal(info.si_signo, &info);

            }

            break;

        case EXCP01_SSTP:

        case EXCP03_INT3:

            if (env->eflags & VM_MASK) {

                handle_vm86_trap(env, trapnr);

            } else {

                info.si_signo = SIGTRAP;

                info.si_errno = 0;

                if (trapnr == EXCP01_SSTP) {

                    info.si_code = TARGET_TRAP_BRKPT;

                    info._sifields._sigfault._addr = env->eip;

                } else {

                    info.si_code = TARGET_SI_KERNEL;

                    info._sifields._sigfault._addr = 0;

                }

                queue_signal(info.si_signo, &info);

            }

            break;

        case EXCP04_INTO:

        case EXCP05_BOUND:

            if (env->eflags & VM_MASK) {

                handle_vm86_trap(env, trapnr);

            } else {

                info.si_signo = SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SI_KERNEL;

                info._sifields._sigfault._addr = 0;

                queue_signal(info.si_signo, &info);

            }

            break;

        case EXCP06_ILLOP:

            info.si_signo = SIGILL;

            info.si_errno = 0;

            info.si_code = TARGET_ILL_ILLOPN;

            info._sifields._sigfault._addr = env->eip;

            queue_signal(info.si_signo, &info);

            break;

        case EXCP_INTERRUPT:

            /* just indicate that signals should be handled asap */

            break;

        case EXCP_DEBUG:

            {

                int sig;

                sig = gdb_handlesig (env, TARGET_SIGTRAP);

                if (sig)

                  {

                    info.si_signo = sig;

                    info.si_errno = 0;

                    info.si_code = TARGET_TRAP_BRKPT;

                    queue_signal(info.si_signo, &info);

                  }

            }

            break;

        default:

            pc = env->segs[R_CS].base + env->eip;

            fprintf(stderr, "qemu: 0x%08lx: unhandled CPU exception 0x%x - aborting\n", 

                    (long)pc, trapnr);

            abort();

        }

        process_pending_signals(env);

    }

}

#endif

#ifdef TARGET_ARM

/* XXX: find a better solution */

extern void tb_invalidate_page_range(target_ulong start, target_ulong end);

static void arm_cache_flush(target_ulong start, target_ulong last)

{

    target_ulong addr, last1;

    if (last < start)

        return;

    addr = start;

    for(;;) {

        last1 = ((addr + TARGET_PAGE_SIZE) & TARGET_PAGE_MASK) - 1;

        if (last1 > last)

            last1 = last;

        tb_invalidate_page_range(addr, last1 + 1);

        if (last1 == last)

            break;

        addr = last1 + 1;

    }

}

void cpu_loop(CPUARMState *env)

{

    int trapnr;

    unsigned int n, insn;

    target_siginfo_t info;

    for(;;) {

        trapnr = cpu_arm_exec(env);

        switch(trapnr) {

        case EXCP_UDEF:

            {

                TaskState *ts = env->opaque;

                uint32_t opcode;

                /* we handle the FPU emulation here, as Linux */

                /* we get the opcode */

                opcode = ldl_raw((uint8_t *)env->regs[15]);

                if (EmulateAll(opcode, &ts->fpa, env->regs) == 0) {

                    info.si_signo = SIGILL;

                    info.si_errno = 0;

                    info.si_code = TARGET_ILL_ILLOPN;

                    info._sifields._sigfault._addr = env->regs[15];

                    queue_signal(info.si_signo, &info);

                } else {

                    /* increment PC */

                    env->regs[15] += 4;

                }

            }

            break;

        case EXCP_SWI:

            {

                /* system call */

                if (env->thumb) {

                    insn = lduw((void *)(env->regs[15] - 2));

                    n = insn & 0xff;

                } else {

                    insn = ldl((void *)(env->regs[15] - 4));

                    n = insn & 0xffffff;

                }

                if (n == ARM_NR_cacheflush) {

                    arm_cache_flush(env->regs[0], env->regs[1]);

                } else if (n == ARM_NR_semihosting

                           || n == ARM_NR_thumb_semihosting) {

                    env->regs[0] = do_arm_semihosting (env);

                } else if (n >= ARM_SYSCALL_BASE

                           || (env->thumb && n == ARM_THUMB_SYSCALL)) {

                    /* linux syscall */

                    if (env->thumb) {

                        n = env->regs[7];

                    } else {

                        n -= ARM_SYSCALL_BASE;

                    }

                    env->regs[0] = do_syscall(env, 

                                              n, 

                                              env->regs[0],

                                              env->regs[1],

                                              env->regs[2],

                                              env->regs[3],

                                              env->regs[4],

                                              env->regs[5]);

                } else {

                    goto error;

                }

            }

            break;

        case EXCP_INTERRUPT:

            /* just indicate that signals should be handled asap */

            break;

        case EXCP_PREFETCH_ABORT:

        case EXCP_DATA_ABORT:

            {

                info.si_signo = SIGSEGV;

                info.si_errno = 0;

                /* XXX: check env->error_code */

                info.si_code = TARGET_SEGV_MAPERR;

                info._sifields._sigfault._addr = env->cp15_6;

                queue_signal(info.si_signo, &info);

            }

            break;

        case EXCP_DEBUG:

            {

                int sig;

                sig = gdb_handlesig (env, TARGET_SIGTRAP);

                if (sig)

                  {

                    info.si_signo = sig;

                    info.si_errno = 0;

                    info.si_code = TARGET_TRAP_BRKPT;

                    queue_signal(info.si_signo, &info);

                  }

            }

            break;

        default:

        error:

            fprintf(stderr, "qemu: unhandled CPU exception 0x%x - aborting\n", 

                    trapnr);

            cpu_dump_state(env, stderr, fprintf, 0);

            abort();

        }

        process_pending_signals(env);

    }

}

#endif

#ifdef TARGET_SPARC

//#define DEBUG_WIN

/* WARNING: dealing with register windows _is_ complicated. More info

   can be found at http://www.sics.se/~psm/sparcstack.html */

static inline int get_reg_index(CPUSPARCState *env, int cwp, int index)

{

    index = (index + cwp * 16) & (16 * NWINDOWS - 1);

    /* wrap handling : if cwp is on the last window, then we use the

       registers 'after' the end */

    if (index < 8 && env->cwp == (NWINDOWS - 1))

        index += (16 * NWINDOWS);

    return index;

}

/* save the register window 'cwp1' */

static inline void save_window_offset(CPUSPARCState *env, int cwp1)

{

    unsigned int i;

    uint32_t *sp_ptr;

    sp_ptr = (uint32_t *)(env->regbase[get_reg_index(env, cwp1, 6)]);

#if defined(DEBUG_WIN)

    printf("win_overflow: sp_ptr=0x%x save_cwp=%d\n", 

           (int)sp_ptr, cwp1);

#endif

    for(i = 0; i < 16; i++) {

        put_user(env->regbase[get_reg_index(env, cwp1, 8 + i)], sp_ptr);

        sp_ptr++;

    }

}

static void save_window(CPUSPARCState *env)

{

    unsigned int new_wim;

    new_wim = ((env->wim >> 1) | (env->wim << (NWINDOWS - 1))) &

        ((1LL << NWINDOWS) - 1);

    save_window_offset(env, (env->cwp - 2) & (NWINDOWS - 1));

    env->wim = new_wim;

}

static void restore_window(CPUSPARCState *env)

{

    unsigned int new_wim, i, cwp1;

    uint32_t *sp_ptr, reg;

    new_wim = ((env->wim << 1) | (env->wim >> (NWINDOWS - 1))) &

        ((1LL << NWINDOWS) - 1);

    /* restore the invalid window */

    cwp1 = (env->cwp + 1) & (NWINDOWS - 1);

    sp_ptr = (uint32_t *)(env->regbase[get_reg_index(env, cwp1, 6)]);

#if defined(DEBUG_WIN)

    printf("win_underflow: sp_ptr=0x%x load_cwp=%d\n", 

           (int)sp_ptr, cwp1);

#endif

    for(i = 0; i < 16; i++) {

        get_user(reg, sp_ptr);

        env->regbase[get_reg_index(env, cwp1, 8 + i)] = reg;

        sp_ptr++;

    }

    env->wim = new_wim;

}

static void flush_windows(CPUSPARCState *env)

{

    int offset, cwp1;

    offset = 1;

    for(;;) {

        /* if restore would invoke restore_window(), then we can stop */

        cwp1 = (env->cwp + offset) & (NWINDOWS - 1);

        if (env->wim & (1 << cwp1))

            break;

        save_window_offset(env, cwp1);

        offset++;

    }

    /* set wim so that restore will reload the registers */

    cwp1 = (env->cwp + 1) & (NWINDOWS - 1);

    env->wim = 1 << cwp1;

#if defined(DEBUG_WIN)

    printf("flush_windows: nb=%d\n", offset - 1);

#endif

}

void cpu_loop (CPUSPARCState *env)

{

    int trapnr, ret;

    target_siginfo_t info;

    while (1) {

        trapnr = cpu_sparc_exec (env);

        switch (trapnr) {

        case 0x88: 

        case 0x90:

            ret = do_syscall (env, env->gregs[1],

                              env->regwptr[0], env->regwptr[1], 

                              env->regwptr[2], env->regwptr[3], 

                              env->regwptr[4], env->regwptr[5]);

            if ((unsigned int)ret >= (unsigned int)(-515)) {

                env->psr |= PSR_CARRY;

                ret = -ret;

            } else {

                env->psr &= ~PSR_CARRY;

            }

            env->regwptr[0] = ret;

            /* next instruction */

            env->pc = env->npc;

            env->npc = env->npc + 4;

            break;

        case 0x83: /* flush windows */

            flush_windows(env);

            /* next instruction */

            env->pc = env->npc;

            env->npc = env->npc + 4;

            break;

#ifndef TARGET_SPARC64

        case TT_WIN_OVF: /* window overflow */

            save_window(env);

            break;

        case TT_WIN_UNF: /* window underflow */

            restore_window(env);

            break;

        case TT_TFAULT:

        case TT_DFAULT:

            {

                info.si_signo = SIGSEGV;

                info.si_errno = 0;

                /* XXX: check env->error_code */

                info.si_code = TARGET_SEGV_MAPERR;

                info._sifields._sigfault._addr = env->mmuregs[4];

                queue_signal(info.si_signo, &info);

            }

            break;

#else

            // XXX

#endif

        case 0x100: // XXX, why do we get these?

            break;

        case EXCP_DEBUG:

            {

                int sig;

                sig = gdb_handlesig (env, TARGET_SIGTRAP);

                if (sig)

                  {

                    info.si_signo = sig;

                    info.si_errno = 0;

                    info.si_code = TARGET_TRAP_BRKPT;

                    queue_signal(info.si_signo, &info);

                  }

            }

            break;

        default:

            printf ("Unhandled trap: 0x%x\n", trapnr);

            cpu_dump_state(env, stderr, fprintf, 0);

            exit (1);

        }

        process_pending_signals (env);

    }

}

#endif

#ifdef TARGET_PPC

static inline uint64_t cpu_ppc_get_tb (CPUState *env)

{

    /* TO FIX */

    return 0;

}

uint32_t cpu_ppc_load_tbl (CPUState *env)

{

    return cpu_ppc_get_tb(env) & 0xFFFFFFFF;

}

uint32_t cpu_ppc_load_tbu (CPUState *env)

{

    return cpu_ppc_get_tb(env) >> 32;

}

static void cpu_ppc_store_tb (CPUState *env, uint64_t value)

{

    /* TO FIX */

}

void cpu_ppc_store_tbu (CPUState *env, uint32_t value)

{

    cpu_ppc_store_tb(env, ((uint64_t)value << 32) | cpu_ppc_load_tbl(env));

}

void cpu_ppc_store_tbl (CPUState *env, uint32_t value)

{

    cpu_ppc_store_tb(env, ((uint64_t)cpu_ppc_load_tbl(env) << 32) | value);

}

uint32_t cpu_ppc_load_decr (CPUState *env)

{

    /* TO FIX */

    return -1;

}

void cpu_ppc_store_decr (CPUState *env, uint32_t value)

{

    /* TO FIX */

}

void cpu_loop(CPUPPCState *env)

{

    target_siginfo_t info;

    int trapnr;

    uint32_t ret;

    for(;;) {

        trapnr = cpu_ppc_exec(env);

        if (trapnr != EXCP_SYSCALL_USER && trapnr != EXCP_BRANCH &&

            trapnr != EXCP_TRACE) {

            if (loglevel > 0) {

                cpu_dump_state(env, logfile, fprintf, 0);

            }

        }

        switch(trapnr) {

        case EXCP_NONE:

            break;

        case EXCP_SYSCALL_USER:

            /* system call */

            /* WARNING:

             * PPC ABI uses overflow flag in cr0 to signal an error

             * in syscalls.

             */

#if 0

            printf("syscall %d 0x%08x 0x%08x 0x%08x 0x%08x\n", env->gpr[0],

                   env->gpr[3], env->gpr[4], env->gpr[5], env->gpr[6]);

#endif

            env->crf[0] &= ~0x1;

            ret = do_syscall(env, env->gpr[0], env->gpr[3], env->gpr[4],

                             env->gpr[5], env->gpr[6], env->gpr[7],

                             env->gpr[8]);

            if (ret > (uint32_t)(-515)) {

                env->crf[0] |= 0x1;

                ret = -ret;

            }

            env->gpr[3] = ret;

#if 0

            printf("syscall returned 0x%08x (%d)\n", ret, ret);

#endif

            break;

        case EXCP_RESET:

            /* Should not happen ! */

            fprintf(stderr, "RESET asked... Stop emulation\n");

            if (loglevel)

                fprintf(logfile, "RESET asked... Stop emulation\n");

            abort();

        case EXCP_MACHINE_CHECK:

            fprintf(stderr, "Machine check exeption...  Stop emulation\n");

            if (loglevel)

                fprintf(logfile, "RESET asked... Stop emulation\n");

            info.si_signo = TARGET_SIGBUS;

            info.si_errno = 0;

            info.si_code = TARGET_BUS_OBJERR;

            info._sifields._sigfault._addr = env->nip - 4;

            queue_signal(info.si_signo, &info);

        case EXCP_DSI:

            fprintf(stderr, "Invalid data memory access: 0x%08x\n", env->spr[DAR]);

            if (loglevel) {

                fprintf(logfile, "Invalid data memory access: 0x%08x\n",

                        env->spr[DAR]);

            }

            switch (env->error_code & 0xF) {

            case EXCP_DSI_TRANSLATE:

                info.si_signo = TARGET_SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SEGV_MAPERR;

                break;

            case EXCP_DSI_NOTSUP:

            case EXCP_DSI_EXTERNAL:

                info.si_signo = TARGET_SIGILL;

                info.si_errno = 0;

                info.si_code = TARGET_ILL_ILLADR;

                break;

            case EXCP_DSI_PROT: 

                info.si_signo = TARGET_SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SEGV_ACCERR;

                break;

            case EXCP_DSI_DABR:

                info.si_signo = TARGET_SIGTRAP;

                info.si_errno = 0;

                info.si_code = TARGET_TRAP_BRKPT;

                break;

            default:

                /* Let's send a regular segfault... */

                fprintf(stderr, "Invalid segfault errno (%02x)\n",

                        env->error_code);

                if (loglevel) {

                    fprintf(logfile, "Invalid segfault errno (%02x)\n",

                            env->error_code);

                }

                info.si_signo = TARGET_SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SEGV_MAPERR;

                break;

            }

            info._sifields._sigfault._addr = env->nip;

            queue_signal(info.si_signo, &info);

            break;

        case EXCP_ISI:

            fprintf(stderr, "Invalid instruction fetch\n");

            if (loglevel)

                fprintf(logfile, "Invalid instruction fetch\n");

            switch (env->error_code) {

            case EXCP_ISI_TRANSLATE:

                info.si_signo = TARGET_SIGSEGV;

            info.si_errno = 0;

                info.si_code = TARGET_SEGV_MAPERR;

                break;

            case EXCP_ISI_GUARD:

                info.si_signo = TARGET_SIGILL;

                info.si_errno = 0;

                info.si_code = TARGET_ILL_ILLADR;

                break;

            case EXCP_ISI_NOEXEC:

            case EXCP_ISI_PROT:

                info.si_signo = TARGET_SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SEGV_ACCERR;

                break;

            default:

                /* Let's send a regular segfault... */

                fprintf(stderr, "Invalid segfault errno (%02x)\n",

                        env->error_code);

                if (loglevel) {

                    fprintf(logfile, "Invalid segfault errno (%02x)\n",

                            env->error_code);

                }

                info.si_signo = TARGET_SIGSEGV;

                info.si_errno = 0;

                info.si_code = TARGET_SEGV_MAPERR;

                break;

            }

            info._sifields._sigfault._addr = env->nip - 4;

            queue_signal(info.si_signo, &info);

            break;

        case EXCP_EXTERNAL:

            /* Should not happen ! */

            fprintf(stderr, "External interruption... Stop emulation\n");

            if (loglevel)

                fprintf(logfile, "External interruption... Stop emulation\n");

            abort();

        case EXCP_ALIGN:

            fprintf(stderr, "Invalid unaligned memory access\n");

            if (loglevel)

                fprintf(logfile, "Invalid unaligned memory access\n");

            info.si_signo = TARGET_SIGBUS;

            info.si_errno = 0;

            info.si_code = TARGET_BUS_ADRALN;

            info._sifields._sigfault._addr = env->nip - 4;

            queue_signal(info.si_signo, &info);

            break;

        case EXCP_PROGRAM:

            switch (env->error_code & ~0xF) {

            case EXCP_FP:

            fprintf(stderr, "Program exception\n");

                if (loglevel)

                    fprintf(logfile, "Program exception\n");

                /* Set FX */

                env->fpscr[7] |= 0x8;

                /* Finally, update FEX */

                if ((((env->fpscr[7] & 0x3) << 3) | (env->fpscr[6] >> 1)) &

                    ((env->fpscr[1] << 1) | (env->fpscr[0] >> 3)))

                    env->fpscr[7] |= 0x4;

                info.si_signo = TARGET_SIGFPE;

                info.si_errno = 0;

                switch (env->error_code & 0xF) {

                case EXCP_FP_OX:

                    info.si_code = TARGET_FPE_FLTOVF;

                    break;

                case EXCP_FP_UX:

                    info.si_code = TARGET_FPE_FLTUND;

                    break;

                case EXCP_FP_ZX:

                case EXCP_FP_VXZDZ:

                    info.si_code = TARGET_FPE_FLTDIV;

                    break;

                case EXCP_FP_XX:

                    info.si_code = TARGET_FPE_FLTRES;

                    break;

                case EXCP_FP_VXSOFT:

                    info.si_code = TARGET_FPE_FLTINV;

                    break;

                case EXCP_FP_VXNAN:

                case EXCP_FP_VXISI:

                case EXCP_FP_VXIDI:

                case EXCP_FP_VXIMZ:

                case EXCP_FP_VXVC:

                case EXCP_FP_VXSQRT:

                case EXCP_FP_VXCVI:

                    info.si_code = TARGET_FPE_FLTSUB;

                    break;

                default:

                    fprintf(stderr, "Unknown floating point exception "

                            "(%02x)\n", env->error_code);

                    if (loglevel) {

                        fprintf(logfile, "Unknown floating point exception "

                                "(%02x)\n", env->error_code & 0xF);

                    }

                }

            break;

        case EXCP_INVAL:

                fprintf(stderr, "Invalid instruction\n");

                if (loglevel)

                    fprintf(logfile, "Invalid instruction\n");

                info.si_signo = TARGET_SIGILL;

                info.si_errno = 0;

                switch (env->error_code & 0xF) {

                case EXCP_INVAL_INVAL:

                    info.si_code = TARGET_ILL_ILLOPC;

                    break;

                case EXCP_INVAL_LSWX:

            info.si_code = TARGET_ILL_ILLOPN;

                    break;

                case EXCP_INVAL_SPR:

                    info.si_code = TARGET_ILL_PRVREG;

                    break;

                case EXCP_INVAL_FP:

                    info.si_code = TARGET_ILL_COPROC;

                    break;

                default:

                    fprintf(stderr, "Unknown invalid operation (%02x)\n",

                            env->error_code & 0xF);

                    if (loglevel) {

                        fprintf(logfile, "Unknown invalid operation (%02x)\n",

                                env->error_code & 0xF);

                    }

                    info.si_code = TARGET_ILL_ILLADR;

                    break;

                }

                break;

            case EXCP_PRIV:

                fprintf(stderr, "Privilege violation\n");

                if (loglevel)

                    fprintf(logfile, "Privilege violation\n");