Archipelago » qemu

/*

 *  MIPS emulation helpers for qemu.

 *

 *  Copyright (c) 2004-2005 Jocelyn Mayer

 *

 * This library is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Lesser General Public

 * License as published by the Free Software Foundation; either

 * version 2 of the License, or (at your option) any later version.

 *

 * This library 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

 * Lesser General Public License for more details.

 *

 * You should have received a copy of the GNU Lesser General Public

 * License along with this library; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 */

#include <stdlib.h>

#include "exec.h"

#include "host-utils.h"

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

/* Exceptions processing helpers */

void do_raise_exception_err (uint32_t exception, int error_code)

{

#if 1

    if (logfile && exception < 0x100)

        fprintf(logfile, "%s: %d %d\n", __func__, exception, error_code);

#endif

    env->exception_index = exception;

    env->error_code = error_code;

    cpu_loop_exit();

}

void do_raise_exception (uint32_t exception)

{

    do_raise_exception_err(exception, 0);

}

void do_interrupt_restart (void)

{

    if (!(env->CP0_Status & (1 << CP0St_EXL)) &&

        !(env->CP0_Status & (1 << CP0St_ERL)) &&

        !(env->hflags & MIPS_HFLAG_DM) &&

        (env->CP0_Status & (1 << CP0St_IE)) &&

        (env->CP0_Status & env->CP0_Cause & CP0Ca_IP_mask)) {

        env->CP0_Cause &= ~(0x1f << CP0Ca_EC);

        do_raise_exception(EXCP_EXT_INTERRUPT);

    }

}

void do_restore_state (void *pc_ptr)

{

    TranslationBlock *tb;

    unsigned long pc = (unsigned long) pc_ptr;

    tb = tb_find_pc (pc);

    if (tb) {

        cpu_restore_state (tb, env, pc, NULL);

    }

}

target_ulong do_clo (target_ulong t0)

{

    return clo32(t0);

}

target_ulong do_clz (target_ulong t0)

{

    return clz32(t0);

}

#if defined(TARGET_MIPS64)

target_ulong do_dclo (target_ulong t0)

{

    return clo64(t0);

}

target_ulong do_dclz (target_ulong t0)

{

    return clz64(t0);

}

#endif /* TARGET_MIPS64 */

/* 64 bits arithmetic for 32 bits hosts */

static always_inline uint64_t get_HILO (void)

{

    return ((uint64_t)(env->HI[env->current_tc][0]) << 32) | (uint32_t)env->LO[env->current_tc][0];

}

static always_inline void set_HILO (uint64_t HILO)

{

    env->LO[env->current_tc][0] = (int32_t)HILO;

    env->HI[env->current_tc][0] = (int32_t)(HILO >> 32);

}

static always_inline void set_HIT0_LO (target_ulong t0, uint64_t HILO)

{

    env->LO[env->current_tc][0] = (int32_t)(HILO & 0xFFFFFFFF);

    t0 = env->HI[env->current_tc][0] = (int32_t)(HILO >> 32);

}

static always_inline void set_HI_LOT0 (target_ulong t0, uint64_t HILO)

{

    t0 = env->LO[env->current_tc][0] = (int32_t)(HILO & 0xFFFFFFFF);

    env->HI[env->current_tc][0] = (int32_t)(HILO >> 32);

}

#if TARGET_LONG_BITS > HOST_LONG_BITS

void do_madd (target_ulong t0, target_ulong t1)

{

    int64_t tmp;

    tmp = ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1);

    set_HILO((int64_t)get_HILO() + tmp);

}

void do_maddu (target_ulong t0, target_ulong t1)

{

    uint64_t tmp;

    tmp = ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1);

    set_HILO(get_HILO() + tmp);

}

void do_msub (target_ulong t0, target_ulong t1)

{

    int64_t tmp;

    tmp = ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1);

    set_HILO((int64_t)get_HILO() - tmp);

}

void do_msubu (target_ulong t0, target_ulong t1)

{

    uint64_t tmp;

    tmp = ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1);

    set_HILO(get_HILO() - tmp);

}

#endif /* TARGET_LONG_BITS > HOST_LONG_BITS */

/* Multiplication variants of the vr54xx. */

target_ulong do_muls (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, 0 - ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_mulsu (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, 0 - ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

target_ulong do_macc (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, ((int64_t)get_HILO()) + ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_macchi (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, ((int64_t)get_HILO()) + ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_maccu (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, ((uint64_t)get_HILO()) + ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

target_ulong do_macchiu (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, ((uint64_t)get_HILO()) + ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

target_ulong do_msac (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, ((int64_t)get_HILO()) - ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_msachi (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, ((int64_t)get_HILO()) - ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_msacu (target_ulong t0, target_ulong t1)

{

    set_HI_LOT0(t0, ((uint64_t)get_HILO()) - ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

target_ulong do_msachiu (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, ((uint64_t)get_HILO()) - ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

target_ulong do_mulhi (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, (int64_t)(int32_t)t0 * (int64_t)(int32_t)t1);

    return t0;

}

target_ulong do_mulhiu (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, (uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1);

    return t0;

}

target_ulong do_mulshi (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, 0 - ((int64_t)(int32_t)t0 * (int64_t)(int32_t)t1));

    return t0;

}

target_ulong do_mulshiu (target_ulong t0, target_ulong t1)

{

    set_HIT0_LO(t0, 0 - ((uint64_t)(uint32_t)t0 * (uint64_t)(uint32_t)t1));

    return t0;

}

#ifdef TARGET_MIPS64

void do_dmult (target_ulong t0, target_ulong t1)

{

    muls64(&(env->LO[env->current_tc][0]), &(env->HI[env->current_tc][0]), t0, t1);

}

void do_dmultu (target_ulong t0, target_ulong t1)

{

    mulu64(&(env->LO[env->current_tc][0]), &(env->HI[env->current_tc][0]), t0, t1);

}

#endif

#ifdef TARGET_WORDS_BIGENDIAN

#define GET_LMASK(v) ((v) & 3)

#define GET_OFFSET(addr, offset) (addr + (offset))

#else

#define GET_LMASK(v) (((v) & 3) ^ 3)

#define GET_OFFSET(addr, offset) (addr - (offset))

#endif

target_ulong do_lwl(target_ulong t0, target_ulong t1, int mem_idx)

{

    target_ulong tmp;

#ifdef CONFIG_USER_ONLY

#define ldfun ldub_raw

#else

    int (*ldfun)(target_ulong);

    switch (mem_idx)

    {

    case 0: ldfun = ldub_kernel; break;

    case 1: ldfun = ldub_super; break;

    default:

    case 2: ldfun = ldub_user; break;

    }

#endif

    tmp = ldfun(t0);

    t1 = (t1 & 0x00FFFFFF) | (tmp << 24);

    if (GET_LMASK(t0) <= 2) {

        tmp = ldfun(GET_OFFSET(t0, 1));

        t1 = (t1 & 0xFF00FFFF) | (tmp << 16);

    }

    if (GET_LMASK(t0) <= 1) {

        tmp = ldfun(GET_OFFSET(t0, 2));

        t1 = (t1 & 0xFFFF00FF) | (tmp << 8);

    }

    if (GET_LMASK(t0) == 0) {

        tmp = ldfun(GET_OFFSET(t0, 3));

        t1 = (t1 & 0xFFFFFF00) | tmp;

    }

    return (int32_t)t1;

}

target_ulong do_lwr(target_ulong t0, target_ulong t1, int mem_idx)

{

    target_ulong tmp;

#ifdef CONFIG_USER_ONLY

#define ldfun ldub_raw

#else

    int (*ldfun)(target_ulong);

    switch (mem_idx)

    {

    case 0: ldfun = ldub_kernel; break;

    case 1: ldfun = ldub_super; break;

    default:

    case 2: ldfun = ldub_user; break;

    }

#endif

    tmp = ldfun(t0);

    t1 = (t1 & 0xFFFFFF00) | tmp;

    if (GET_LMASK(t0) >= 1) {

        tmp = ldfun(GET_OFFSET(t0, -1));

        t1 = (t1 & 0xFFFF00FF) | (tmp << 8);

    }

    if (GET_LMASK(t0) >= 2) {

        tmp = ldfun(GET_OFFSET(t0, -2));

        t1 = (t1 & 0xFF00FFFF) | (tmp << 16);

    }

    if (GET_LMASK(t0) == 3) {

        tmp = ldfun(GET_OFFSET(t0, -3));

        t1 = (t1 & 0x00FFFFFF) | (tmp << 24);

    }

    return (int32_t)t1;

}

void do_swl(target_ulong t0, target_ulong t1, int mem_idx)

{

#ifdef CONFIG_USER_ONLY

#define stfun stb_raw

#else

    void (*stfun)(target_ulong, int);

    switch (mem_idx)

    {

    case 0: stfun = stb_kernel; break;

    case 1: stfun = stb_super; break;

    default:

    case 2: stfun = stb_user; break;

    }

#endif

    stfun(t0, (uint8_t)(t1 >> 24));

    if (GET_LMASK(t0) <= 2)

        stfun(GET_OFFSET(t0, 1), (uint8_t)(t1 >> 16));

    if (GET_LMASK(t0) <= 1)

        stfun(GET_OFFSET(t0, 2), (uint8_t)(t1 >> 8));

    if (GET_LMASK(t0) == 0)

        stfun(GET_OFFSET(t0, 3), (uint8_t)t1);

}

void do_swr(target_ulong t0, target_ulong t1, int mem_idx)

{

#ifdef CONFIG_USER_ONLY

#define stfun stb_raw

#else

    void (*stfun)(target_ulong, int);

    switch (mem_idx)

    {

    case 0: stfun = stb_kernel; break;

    case 1: stfun = stb_super; break;

    default:

    case 2: stfun = stb_user; break;

    }

#endif

    stfun(t0, (uint8_t)t1);

    if (GET_LMASK(t0) >= 1)

        stfun(GET_OFFSET(t0, -1), (uint8_t)(t1 >> 8));

    if (GET_LMASK(t0) >= 2)

        stfun(GET_OFFSET(t0, -2), (uint8_t)(t1 >> 16));

    if (GET_LMASK(t0) == 3)

        stfun(GET_OFFSET(t0, -3), (uint8_t)(t1 >> 24));

}

#if defined(TARGET_MIPS64)

/* "half" load and stores.  We must do the memory access inline,

   or fault handling won't work.  */

#ifdef TARGET_WORDS_BIGENDIAN

#define GET_LMASK64(v) ((v) & 7)

#else

#define GET_LMASK64(v) (((v) & 7) ^ 7)

#endif

target_ulong do_ldl(target_ulong t0, target_ulong t1, int mem_idx)

{

    uint64_t tmp;

#ifdef CONFIG_USER_ONLY

#define ldfun ldub_raw

#else

    int (*ldfun)(target_ulong);

    switch (mem_idx)

    {

    case 0: ldfun = ldub_kernel; break;

    case 1: ldfun = ldub_super; break;

    default:

    case 2: ldfun = ldub_user; break;

    }

#endif

    tmp = ldfun(t0);

    t1 = (t1 & 0x00FFFFFFFFFFFFFFULL) | (tmp << 56);

    if (GET_LMASK64(t0) <= 6) {

        tmp = ldfun(GET_OFFSET(t0, 1));

        t1 = (t1 & 0xFF00FFFFFFFFFFFFULL) | (tmp << 48);

    }

    if (GET_LMASK64(t0) <= 5) {

        tmp = ldfun(GET_OFFSET(t0, 2));

        t1 = (t1 & 0xFFFF00FFFFFFFFFFULL) | (tmp << 40);

    }

    if (GET_LMASK64(t0) <= 4) {

        tmp = ldfun(GET_OFFSET(t0, 3));

        t1 = (t1 & 0xFFFFFF00FFFFFFFFULL) | (tmp << 32);

    }

    if (GET_LMASK64(t0) <= 3) {

        tmp = ldfun(GET_OFFSET(t0, 4));

        t1 = (t1 & 0xFFFFFFFF00FFFFFFULL) | (tmp << 24);

    }

    if (GET_LMASK64(t0) <= 2) {

        tmp = ldfun(GET_OFFSET(t0, 5));

        t1 = (t1 & 0xFFFFFFFFFF00FFFFULL) | (tmp << 16);

    }

    if (GET_LMASK64(t0) <= 1) {

        tmp = ldfun(GET_OFFSET(t0, 6));

        t1 = (t1 & 0xFFFFFFFFFFFF00FFULL) | (tmp << 8);

    }

    if (GET_LMASK64(t0) == 0) {

        tmp = ldfun(GET_OFFSET(t0, 7));

        t1 = (t1 & 0xFFFFFFFFFFFFFF00ULL) | tmp;

    }

    return t1;

}

target_ulong do_ldr(target_ulong t0, target_ulong t1, int mem_idx)

{

    uint64_t tmp;

#ifdef CONFIG_USER_ONLY

#define ldfun ldub_raw

#else

    int (*ldfun)(target_ulong);

    switch (mem_idx)

    {

    case 0: ldfun = ldub_kernel; break;

    case 1: ldfun = ldub_super; break;

    default:

    case 2: ldfun = ldub_user; break;

    }

#endif

    tmp = ldfun(t0);

    t1 = (t1 & 0xFFFFFFFFFFFFFF00ULL) | tmp;

    if (GET_LMASK64(t0) >= 1) {

        tmp = ldfun(GET_OFFSET(t0, -1));

        t1 = (t1 & 0xFFFFFFFFFFFF00FFULL) | (tmp  << 8);

    }

    if (GET_LMASK64(t0) >= 2) {

        tmp = ldfun(GET_OFFSET(t0, -2));

        t1 = (t1 & 0xFFFFFFFFFF00FFFFULL) | (tmp << 16);

    }

    if (GET_LMASK64(t0) >= 3) {

        tmp = ldfun(GET_OFFSET(t0, -3));

        t1 = (t1 & 0xFFFFFFFF00FFFFFFULL) | (tmp << 24);

    }

    if (GET_LMASK64(t0) >= 4) {

        tmp = ldfun(GET_OFFSET(t0, -4));

        t1 = (t1 & 0xFFFFFF00FFFFFFFFULL) | (tmp << 32);

    }

    if (GET_LMASK64(t0) >= 5) {

        tmp = ldfun(GET_OFFSET(t0, -5));

        t1 = (t1 & 0xFFFF00FFFFFFFFFFULL) | (tmp << 40);

    }

    if (GET_LMASK64(t0) >= 6) {

        tmp = ldfun(GET_OFFSET(t0, -6));

        t1 = (t1 & 0xFF00FFFFFFFFFFFFULL) | (tmp << 48);

    }

    if (GET_LMASK64(t0) == 7) {

        tmp = ldfun(GET_OFFSET(t0, -7));

        t1 = (t1 & 0x00FFFFFFFFFFFFFFULL) | (tmp << 56);

    }

    return t1;

}

void do_sdl(target_ulong t0, target_ulong t1, int mem_idx)

{

#ifdef CONFIG_USER_ONLY

#define stfun stb_raw

#else

    void (*stfun)(target_ulong, int);

    switch (mem_idx)

    {

    case 0: stfun = stb_kernel; break;

    case 1: stfun = stb_super; break;

    default:

    case 2: stfun = stb_user; break;

    }

#endif

    stfun(t0, (uint8_t)(t1 >> 56));

    if (GET_LMASK64(t0) <= 6)

        stfun(GET_OFFSET(t0, 1), (uint8_t)(t1 >> 48));

    if (GET_LMASK64(t0) <= 5)

        stfun(GET_OFFSET(t0, 2), (uint8_t)(t1 >> 40));

    if (GET_LMASK64(t0) <= 4)

        stfun(GET_OFFSET(t0, 3), (uint8_t)(t1 >> 32));

    if (GET_LMASK64(t0) <= 3)

        stfun(GET_OFFSET(t0, 4), (uint8_t)(t1 >> 24));

    if (GET_LMASK64(t0) <= 2)

        stfun(GET_OFFSET(t0, 5), (uint8_t)(t1 >> 16));

    if (GET_LMASK64(t0) <= 1)

        stfun(GET_OFFSET(t0, 6), (uint8_t)(t1 >> 8));

    if (GET_LMASK64(t0) <= 0)

        stfun(GET_OFFSET(t0, 7), (uint8_t)t1);

}

void do_sdr(target_ulong t0, target_ulong t1, int mem_idx)

{

#ifdef CONFIG_USER_ONLY

#define stfun stb_raw

#else

    void (*stfun)(target_ulong, int);

    switch (mem_idx)

    {

    case 0: stfun = stb_kernel; break;

    case 1: stfun = stb_super; break;

     default:

    case 2: stfun = stb_user; break;

    }

#endif

    stfun(t0, (uint8_t)t1);

    if (GET_LMASK64(t0) >= 1)

        stfun(GET_OFFSET(t0, -1), (uint8_t)(t1 >> 8));

    if (GET_LMASK64(t0) >= 2)

        stfun(GET_OFFSET(t0, -2), (uint8_t)(t1 >> 16));

    if (GET_LMASK64(t0) >= 3)

        stfun(GET_OFFSET(t0, -3), (uint8_t)(t1 >> 24));

    if (GET_LMASK64(t0) >= 4)

        stfun(GET_OFFSET(t0, -4), (uint8_t)(t1 >> 32));

    if (GET_LMASK64(t0) >= 5)

        stfun(GET_OFFSET(t0, -5), (uint8_t)(t1 >> 40));

    if (GET_LMASK64(t0) >= 6)

        stfun(GET_OFFSET(t0, -6), (uint8_t)(t1 >> 48));

    if (GET_LMASK64(t0) == 7)

        stfun(GET_OFFSET(t0, -7), (uint8_t)(t1 >> 56));

}

#endif /* TARGET_MIPS64 */

#ifdef CONFIG_USER_ONLY

void do_mfc0_random (void)

{

    cpu_abort(env, "mfc0 random\n");

}

void do_mfc0_count (void)

{

    cpu_abort(env, "mfc0 count\n");

}

void cpu_mips_store_count(CPUState *env, uint32_t value)

{

    cpu_abort(env, "mtc0 count\n");

}

void cpu_mips_store_compare(CPUState *env, uint32_t value)

{

    cpu_abort(env, "mtc0 compare\n");

}

void cpu_mips_start_count(CPUState *env)

{

    cpu_abort(env, "start count\n");

}

void cpu_mips_stop_count(CPUState *env)

{

    cpu_abort(env, "stop count\n");

}

void cpu_mips_update_irq(CPUState *env)

{

    cpu_abort(env, "mtc0 status / mtc0 cause\n");

}

void do_mtc0_status_debug(uint32_t old, uint32_t val)

{

    cpu_abort(env, "mtc0 status debug\n");

}

void do_mtc0_status_irqraise_debug (void)

{

    cpu_abort(env, "mtc0 status irqraise debug\n");

}

void cpu_mips_tlb_flush (CPUState *env, int flush_global)

{

    cpu_abort(env, "mips_tlb_flush\n");

}

#else

/* CP0 helpers */

target_ulong do_mfc0_mvpcontrol (target_ulong t0)

{

    return env->mvp->CP0_MVPControl;

}

target_ulong do_mfc0_mvpconf0 (target_ulong t0)

{

    return env->mvp->CP0_MVPConf0;

}

target_ulong do_mfc0_mvpconf1 (target_ulong t0)

{

    return env->mvp->CP0_MVPConf1;

}

target_ulong do_mfc0_random (target_ulong t0)

{

    return (int32_t)cpu_mips_get_random(env);

}

target_ulong do_mfc0_tcstatus (target_ulong t0)

{

    return env->CP0_TCStatus[env->current_tc];

}

target_ulong do_mftc0_tcstatus(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCStatus[other_tc];

}

target_ulong do_mfc0_tcbind (target_ulong t0)

{

    return env->CP0_TCBind[env->current_tc];

}

target_ulong do_mftc0_tcbind(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCBind[other_tc];

}

target_ulong do_mfc0_tcrestart (target_ulong t0)

{

    return env->PC[env->current_tc];

}

target_ulong do_mftc0_tcrestart(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->PC[other_tc];

}

target_ulong do_mfc0_tchalt (target_ulong t0)

{

    return env->CP0_TCHalt[env->current_tc];

}

target_ulong do_mftc0_tchalt(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCHalt[other_tc];

}

target_ulong do_mfc0_tccontext (target_ulong t0)

{

    return env->CP0_TCContext[env->current_tc];

}

target_ulong do_mftc0_tccontext(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCContext[other_tc];

}

target_ulong do_mfc0_tcschedule (target_ulong t0)

{

    return env->CP0_TCSchedule[env->current_tc];

}

target_ulong do_mftc0_tcschedule(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCSchedule[other_tc];

}

target_ulong do_mfc0_tcschefback (target_ulong t0)

{

    return env->CP0_TCScheFBack[env->current_tc];

}

target_ulong do_mftc0_tcschefback(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return env->CP0_TCScheFBack[other_tc];

}

target_ulong do_mfc0_count (target_ulong t0)

{

    return (int32_t)cpu_mips_get_count(env);

}

target_ulong do_mftc0_entryhi(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    return (env->CP0_EntryHi & ~0xff) | (env->CP0_TCStatus[other_tc] & 0xff);

}

target_ulong do_mftc0_status(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    uint32_t tcstatus = env->CP0_TCStatus[other_tc];

    t0 = env->CP0_Status & ~0xf1000018;

    t0 |= tcstatus & (0xf << CP0TCSt_TCU0);

    t0 |= (tcstatus & (1 << CP0TCSt_TMX)) >> (CP0TCSt_TMX - CP0St_MX);

    t0 |= (tcstatus & (0x3 << CP0TCSt_TKSU)) >> (CP0TCSt_TKSU - CP0St_KSU);

    return t0;

}

target_ulong do_mfc0_lladdr (target_ulong t0)

{

    return (int32_t)env->CP0_LLAddr >> 4;

}

target_ulong do_mfc0_watchlo (target_ulong t0, uint32_t sel)

{

    return (int32_t)env->CP0_WatchLo[sel];

}

target_ulong do_mfc0_watchhi (target_ulong t0, uint32_t sel)

{

    return env->CP0_WatchHi[sel];

}

target_ulong do_mfc0_debug (target_ulong t0)

{

    t0 = env->CP0_Debug;

    if (env->hflags & MIPS_HFLAG_DM)

        t0 |= 1 << CP0DB_DM;

    return t0;

}

target_ulong do_mftc0_debug(target_ulong t0)

{

    int other_tc = env->CP0_VPEControl & (0xff << CP0VPECo_TargTC);

    /* XXX: Might be wrong, check with EJTAG spec. */

    return (env->CP0_Debug & ~((1 << CP0DB_SSt) | (1 << CP0DB_Halt))) |

            (env->CP0_Debug_tcstatus[other_tc] &

             ((1 << CP0DB_SSt) | (1 << CP0DB_Halt)));

}

#if defined(TARGET_MIPS64)

target_ulong do_dmfc0_tcrestart (target_ulong t0)

{

    return env->PC[env->current_tc];

}

target_ulong do_dmfc0_tchalt (target_ulong t0)

{

    return env->CP0_TCHalt[env->current_tc];

}

target_ulong do_dmfc0_tccontext (target_ulong t0)

{

    return env->CP0_TCContext[env->current_tc];

}

target_ulong do_dmfc0_tcschedule (target_ulong t0)

{

    return env->CP0_TCSchedule[env->current_tc];

}

target_ulong do_dmfc0_tcschefback (target_ulong t0)

{

    return env->CP0_TCScheFBack[env->current_tc];

}

target_ulong do_dmfc0_lladdr (target_ulong t0)

{

    return env->CP0_LLAddr >> 4;

}

target_ulong do_dmfc0_watchlo (target_ulong t0, uint32_t sel)

{

    return env->CP0_WatchLo[sel];

}

#endif /* TARGET_MIPS64 */

void do_mtc0_index (target_ulong t0)

{

    int num = 1;

    unsigned int tmp = env->tlb->nb_tlb;

    do {

        tmp >>= 1;

        num <<= 1;

    } while (tmp);

    env->CP0_Index = (env->CP0_Index & 0x80000000) | (t0 & (num - 1));

}

void do_mtc0_mvpcontrol (target_ulong t0)

{

    uint32_t mask = 0;

    uint32_t newval;

    if (env->CP0_VPEConf0 & (1 << CP0VPEC0_MVP))

        mask |= (1 << CP0MVPCo_CPA) | (1 << CP0MVPCo_VPC) |

                (1 << CP0MVPCo_EVP);

    if (env->mvp->CP0_MVPControl & (1 << CP0MVPCo_VPC))

        mask |= (1 << CP0MVPCo_STLB);

    newval = (env->mvp->CP0_MVPControl & ~mask) | (t0 & mask);

    // TODO: Enable/disable shared TLB, enable/disable VPEs.

    env->mvp->CP0_MVPControl = newval;

}

void do_mtc0_vpecontrol (target_ulong t0)

{

    uint32_t mask;

    uint32_t newval;

    mask = (1 << CP0VPECo_YSI) | (1 << CP0VPECo_GSI) |

           (1 << CP0VPECo_TE) | (0xff << CP0VPECo_TargTC);

    newval = (env->CP0_VPEControl & ~mask) | (t0 & mask);

    /* Yield scheduler intercept not implemented. */

    /* Gating storage scheduler intercept not implemented. */

    // TODO: Enable/disable TCs.

    env->CP0_VPEControl = newval;

}

void do_mtc0_vpeconf0 (target_ulong t0)

{

    uint32_t mask = 0;

    uint32_t newval;

    if (env->CP0_VPEConf0 & (1 << CP0VPEC0_MVP)) {

        if (env->CP0_VPEConf0 & (1 << CP0VPEC0_VPA))

            mask |= (0xff << CP0VPEC0_XTC);

        mask |= (1 << CP0VPEC0_MVP) | (1 << CP0VPEC0_VPA);

    }

    newval = (env->CP0_VPEConf0 & ~mask) | (t0 & mask);