Archipelago » qemu

/*

 *  PowerPC emulation micro-operations for qemu.

 *

 *  Copyright (c) 2003-2007 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

 */

//#define DEBUG_OP

#include "config.h"

#include "exec.h"

#include "host-utils.h"

#include "helper_regs.h"

#include "op_helper.h"

void OPPROTO op_print_mem_EA (void)

{

    do_print_mem_EA(T0);

    RETURN();

}

/* PowerPC state maintenance operations */

/* set_Rc0 */

void OPPROTO op_set_Rc0 (void)

{

    env->crf[0] = T0 | xer_so;

    RETURN();

}

/* Generate exceptions */

void OPPROTO op_raise_exception_err (void)

{

    do_raise_exception_err(PARAM1, PARAM2);

}

void OPPROTO op_debug (void)

{

    do_raise_exception(EXCP_DEBUG);

}

/* Load/store special registers */

void OPPROTO op_load_cr (void)

{

    do_load_cr();

    RETURN();

}

void OPPROTO op_store_cr (void)

{

    do_store_cr(PARAM1);

    RETURN();

}

void OPPROTO op_load_xer_cr (void)

{

    T0 = (xer_so << 3) | (xer_ov << 2) | (xer_ca << 1);

    RETURN();

}

void OPPROTO op_clear_xer_ov (void)

{

    xer_so = 0;

    xer_ov = 0;

    RETURN();

}

void OPPROTO op_clear_xer_ca (void)

{

    xer_ca = 0;

    RETURN();

}

void OPPROTO op_load_xer_bc (void)

{

    T1 = xer_bc;

    RETURN();

}

void OPPROTO op_store_xer_bc (void)

{

    xer_bc = T0;

    RETURN();

}

void OPPROTO op_load_xer (void)

{

    T0 = hreg_load_xer(env);

    RETURN();

}

void OPPROTO op_store_xer (void)

{

    hreg_store_xer(env, T0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_store_pri (void)

{

    do_store_pri(PARAM1);

    RETURN();

}

#endif

#if !defined(CONFIG_USER_ONLY)

/* Segment registers load and store */

void OPPROTO op_load_sr (void)

{

    T0 = env->sr[T1];

    RETURN();

}

void OPPROTO op_store_sr (void)

{

    do_store_sr(env, T1, T0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_load_slb (void)

{

    T0 = ppc_load_slb(env, T1);

    RETURN();

}

void OPPROTO op_store_slb (void)

{

    ppc_store_slb(env, T1, T0);

    RETURN();

}

#endif /* defined(TARGET_PPC64) */

void OPPROTO op_load_sdr1 (void)

{

    T0 = env->sdr1;

    RETURN();

}

void OPPROTO op_store_sdr1 (void)

{

    do_store_sdr1(env, T0);

    RETURN();

}

#if defined (TARGET_PPC64)

void OPPROTO op_load_asr (void)

{

    T0 = env->asr;

    RETURN();

}

void OPPROTO op_store_asr (void)

{

    ppc_store_asr(env, T0);

    RETURN();

}

#endif

void OPPROTO op_load_msr (void)

{

    T0 = env->msr;

    RETURN();

}

void OPPROTO op_store_msr (void)

{

    do_store_msr();

    RETURN();

}

#if defined (TARGET_PPC64)

void OPPROTO op_store_msr_32 (void)

{

    T0 = (env->msr & ~0xFFFFFFFFULL) | (T0 & 0xFFFFFFFF);

    do_store_msr();

    RETURN();

}

#endif

void OPPROTO op_update_riee (void)

{

    /* We don't call do_store_msr here as we won't trigger

     * any special case nor change hflags

     */

    T0 &= (1 << MSR_RI) | (1 << MSR_EE);

    env->msr &= ~(1 << MSR_RI) | (1 << MSR_EE);

    env->msr |= T0;

    RETURN();

}

#endif

/* SPR */

void OPPROTO op_load_spr (void)

{

    T0 = env->spr[PARAM1];

    RETURN();

}

void OPPROTO op_store_spr (void)

{

    env->spr[PARAM1] = T0;

    RETURN();

}

void OPPROTO op_load_dump_spr (void)

{

    T0 = ppc_load_dump_spr(PARAM1);

    RETURN();

}

void OPPROTO op_store_dump_spr (void)

{

    ppc_store_dump_spr(PARAM1, T0);

    RETURN();

}

void OPPROTO op_mask_spr (void)

{

    env->spr[PARAM1] &= ~T0;

    RETURN();

}

void OPPROTO op_load_lr (void)

{

    T0 = env->lr;

    RETURN();

}

void OPPROTO op_store_lr (void)

{

    env->lr = T0;

    RETURN();

}

void OPPROTO op_load_ctr (void)

{

    T0 = env->ctr;

    RETURN();

}

void OPPROTO op_store_ctr (void)

{

    env->ctr = T0;

    RETURN();

}

void OPPROTO op_load_tbl (void)

{

    T0 = cpu_ppc_load_tbl(env);

    RETURN();

}

void OPPROTO op_load_tbu (void)

{

    T0 = cpu_ppc_load_tbu(env);

    RETURN();

}

void OPPROTO op_load_atbl (void)

{

    T0 = cpu_ppc_load_atbl(env);

    RETURN();

}

void OPPROTO op_load_atbu (void)

{

    T0 = cpu_ppc_load_atbu(env);

    RETURN();

}

#if !defined(CONFIG_USER_ONLY)

void OPPROTO op_store_tbl (void)

{

    cpu_ppc_store_tbl(env, T0);

    RETURN();

}

void OPPROTO op_store_tbu (void)

{

    cpu_ppc_store_tbu(env, T0);

    RETURN();

}

void OPPROTO op_store_atbl (void)

{

    cpu_ppc_store_atbl(env, T0);

    RETURN();

}

void OPPROTO op_store_atbu (void)

{

    cpu_ppc_store_atbu(env, T0);

    RETURN();

}

void OPPROTO op_load_decr (void)

{

    T0 = cpu_ppc_load_decr(env);

    RETURN();

}

void OPPROTO op_store_decr (void)

{

    cpu_ppc_store_decr(env, T0);

    RETURN();

}

void OPPROTO op_load_ibat (void)

{

    T0 = env->IBAT[PARAM1][PARAM2];

    RETURN();

}

void OPPROTO op_store_ibatu (void)

{

    do_store_ibatu(env, PARAM1, T0);

    RETURN();

}

void OPPROTO op_store_ibatl (void)

{

#if 1

    env->IBAT[1][PARAM1] = T0;

#else

    do_store_ibatl(env, PARAM1, T0);

#endif

    RETURN();

}

void OPPROTO op_load_dbat (void)

{

    T0 = env->DBAT[PARAM1][PARAM2];

    RETURN();

}

void OPPROTO op_store_dbatu (void)

{

    do_store_dbatu(env, PARAM1, T0);

    RETURN();

}

void OPPROTO op_store_dbatl (void)

{

#if 1

    env->DBAT[1][PARAM1] = T0;

#else

    do_store_dbatl(env, PARAM1, T0);

#endif

    RETURN();

}

#endif /* !defined(CONFIG_USER_ONLY) */

/* FPSCR */

#ifdef CONFIG_SOFTFLOAT

void OPPROTO op_reset_fpstatus (void)

{

    env->fp_status.float_exception_flags = 0;

    RETURN();

}

#endif

void OPPROTO op_compute_fprf (void)

{

    do_compute_fprf(PARAM1);

    RETURN();

}

#ifdef CONFIG_SOFTFLOAT

void OPPROTO op_float_check_status (void)

{

    do_float_check_status();

    RETURN();

}

#else

void OPPROTO op_float_check_status (void)

{

    if (env->exception_index == POWERPC_EXCP_PROGRAM &&

        (env->error_code & POWERPC_EXCP_FP)) {

        /* Differred floating-point exception after target FPR update */

        if (msr_fe0 != 0 || msr_fe1 != 0)

            do_raise_exception_err(env->exception_index, env->error_code);

    }

    RETURN();

}

#endif

void OPPROTO op_load_fpscr_FT0 (void)

{

    /* The 32 MSB of the target fpr are undefined.

     * They'll be zero...

     */

    CPU_DoubleU u;

    u.l.upper = 0;

    u.l.lower = env->fpscr;

    FT0 = u.d;

    RETURN();

}

void OPPROTO op_load_fpscr_T0 (void)

{

    T0 = (env->fpscr >> PARAM1) & 0xF;

    RETURN();

}

void OPPROTO op_load_fpcc (void)

{

    T0 = fpscr_fpcc;

    RETURN();

}

void OPPROTO op_fpscr_resetbit (void)

{

    env->fpscr &= PARAM1;

    RETURN();

}

void OPPROTO op_fpscr_setbit (void)

{

    do_fpscr_setbit(PARAM1);

    RETURN();

}

void OPPROTO op_store_fpscr (void)

{

    do_store_fpscr(PARAM1);

    RETURN();

}

/* Branch */

void OPPROTO op_setlr (void)

{

    env->lr = (uint32_t)PARAM1;

    RETURN();

}

#if defined (TARGET_PPC64)

void OPPROTO op_setlr_64 (void)

{

    env->lr = ((uint64_t)PARAM1 << 32) | (uint64_t)PARAM2;

    RETURN();

}

#endif

void OPPROTO op_jz_T0 (void)

{

    if (!T0)

        GOTO_LABEL_PARAM(1);

    RETURN();

}

void OPPROTO op_btest_T1 (void)

{

    if (T0) {

        env->nip = (uint32_t)(T1 & ~3);

    } else {

        env->nip = (uint32_t)PARAM1;

    }

    RETURN();

}

#if defined (TARGET_PPC64)

void OPPROTO op_btest_T1_64 (void)

{

    if (T0) {

        env->nip = (uint64_t)(T1 & ~3);

    } else {

        env->nip = ((uint64_t)PARAM1 << 32) | (uint64_t)PARAM2;

    }

    RETURN();

}

#endif

void OPPROTO op_movl_T1_ctr (void)

{

    T1 = env->ctr;

    RETURN();

}

void OPPROTO op_movl_T1_lr (void)

{

    T1 = env->lr;

    RETURN();

}

/* tests with result in T0 */

void OPPROTO op_test_ctr (void)

{

    T0 = (uint32_t)env->ctr;

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctr_64 (void)

{

    T0 = (uint64_t)env->ctr;

    RETURN();

}

#endif

void OPPROTO op_test_ctr_true (void)

{

    T0 = ((uint32_t)env->ctr != 0 && (T0 & PARAM1) != 0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctr_true_64 (void)

{

    T0 = ((uint64_t)env->ctr != 0 && (T0 & PARAM1) != 0);

    RETURN();

}

#endif

void OPPROTO op_test_ctr_false (void)

{

    T0 = ((uint32_t)env->ctr != 0 && (T0 & PARAM1) == 0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctr_false_64 (void)

{

    T0 = ((uint64_t)env->ctr != 0 && (T0 & PARAM1) == 0);

    RETURN();

}

#endif

void OPPROTO op_test_ctrz (void)

{

    T0 = ((uint32_t)env->ctr == 0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctrz_64 (void)

{

    T0 = ((uint64_t)env->ctr == 0);

    RETURN();

}

#endif

void OPPROTO op_test_ctrz_true (void)

{

    T0 = ((uint32_t)env->ctr == 0 && (T0 & PARAM1) != 0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctrz_true_64 (void)

{

    T0 = ((uint64_t)env->ctr == 0 && (T0 & PARAM1) != 0);

    RETURN();

}

#endif

void OPPROTO op_test_ctrz_false (void)

{

    T0 = ((uint32_t)env->ctr == 0 && (T0 & PARAM1) == 0);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_test_ctrz_false_64 (void)

{

    T0 = ((uint64_t)env->ctr == 0 && (T0 & PARAM1) == 0);

    RETURN();

}

#endif

void OPPROTO op_test_true (void)

{

    T0 = (T0 & PARAM1);

    RETURN();

}

void OPPROTO op_test_false (void)

{

    T0 = ((T0 & PARAM1) == 0);

    RETURN();

}

/* CTR maintenance */

void OPPROTO op_dec_ctr (void)

{

    env->ctr--;

    RETURN();

}

/***                           Integer arithmetic                          ***/

/* add */

void OPPROTO op_check_addo (void)

{

    xer_ov = (((uint32_t)T2 ^ (uint32_t)T1 ^ UINT32_MAX) &

              ((uint32_t)T2 ^ (uint32_t)T0)) >> 31;

    xer_so |= xer_ov;

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_check_addo_64 (void)

{

    xer_ov = (((uint64_t)T2 ^ (uint64_t)T1 ^ UINT64_MAX) &

              ((uint64_t)T2 ^ (uint64_t)T0)) >> 63;

    xer_so |= xer_ov;

    RETURN();

}

#endif

/* add carrying */

void OPPROTO op_check_addc (void)

{

    if (likely((uint32_t)T0 >= (uint32_t)T2)) {

        xer_ca = 0;

    } else {

        xer_ca = 1;

    }

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_check_addc_64 (void)

{

    if (likely((uint64_t)T0 >= (uint64_t)T2)) {

        xer_ca = 0;

    } else {

        xer_ca = 1;

    }

    RETURN();

}

#endif

/* add extended */

void OPPROTO op_adde (void)

{

    do_adde();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_adde_64 (void)

{

    do_adde_64();

    RETURN();

}

#endif

/* add to minus one extended */

void OPPROTO op_add_me (void)

{

    T0 += xer_ca + (-1);

    if (likely((uint32_t)T1 != 0))

        xer_ca = 1;

    else

        xer_ca = 0;

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_add_me_64 (void)

{

    T0 += xer_ca + (-1);

    if (likely((uint64_t)T1 != 0))

        xer_ca = 1;

    else

        xer_ca = 0;

    RETURN();

}

#endif

void OPPROTO op_addmeo (void)

{

    do_addmeo();

    RETURN();

}

void OPPROTO op_addmeo_64 (void)

{

    do_addmeo();

    RETURN();

}

/* add to zero extended */

void OPPROTO op_add_ze (void)

{

    T0 += xer_ca;

    RETURN();

}

/* divide word */

void OPPROTO op_divw (void)

{

    if (unlikely(((int32_t)T0 == INT32_MIN && (int32_t)T1 == (int32_t)-1) ||

                 (int32_t)T1 == 0)) {

        T0 = (int32_t)(UINT32_MAX * ((uint32_t)T0 >> 31));

    } else {

        T0 = (int32_t)T0 / (int32_t)T1;

    }

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_divd (void)

{

    if (unlikely(((int64_t)T0 == INT64_MIN && (int64_t)T1 == (int64_t)-1LL) ||

                 (int64_t)T1 == 0)) {

        T0 = (int64_t)(UINT64_MAX * ((uint64_t)T0 >> 63));

    } else {

        T0 = (int64_t)T0 / (int64_t)T1;

    }

    RETURN();

}

#endif

void OPPROTO op_divwo (void)

{

    do_divwo();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_divdo (void)

{

    do_divdo();

    RETURN();

}

#endif

/* divide word unsigned */

void OPPROTO op_divwu (void)

{

    if (unlikely(T1 == 0)) {

        T0 = 0;

    } else {

        T0 = (uint32_t)T0 / (uint32_t)T1;

    }

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_divdu (void)

{

    if (unlikely(T1 == 0)) {

        T0 = 0;

    } else {

        T0 /= T1;

    }

    RETURN();

}

#endif

void OPPROTO op_divwuo (void)

{

    do_divwuo();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_divduo (void)

{

    do_divduo();

    RETURN();

}

#endif

/* multiply high word */

void OPPROTO op_mulhw (void)

{

    T0 = ((int64_t)((int32_t)T0) * (int64_t)((int32_t)T1)) >> 32;

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_mulhd (void)

{

    uint64_t tl, th;

    muls64(&tl, &th, T0, T1);

    T0 = th;

    RETURN();

}

#endif

/* multiply high word unsigned */

void OPPROTO op_mulhwu (void)

{

    T0 = ((uint64_t)(uint32_t)T0 * (uint64_t)(uint32_t)T1) >> 32;

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_mulhdu (void)

{

    uint64_t tl, th;

    mulu64(&tl, &th, T0, T1);

    T0 = th;

    RETURN();

}

#endif

/* multiply low immediate */

void OPPROTO op_mulli (void)

{

    T0 = ((int32_t)T0 * (int32_t)PARAM1);

    RETURN();

}

/* multiply low word */

void OPPROTO op_mullw (void)

{

    T0 = (int32_t)(T0 * T1);

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_mulld (void)

{

    T0 *= T1;

    RETURN();

}

#endif

void OPPROTO op_mullwo (void)

{

    do_mullwo();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_mulldo (void)

{

    do_mulldo();

    RETURN();

}

#endif

/* negate */

void OPPROTO op_neg (void)

{

    if (likely(T0 != INT32_MIN)) {

        T0 = -(int32_t)T0;

    }

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_neg_64 (void)

{

    if (likely(T0 != INT64_MIN)) {

        T0 = -(int64_t)T0;

    }

    RETURN();

}

#endif

void OPPROTO op_nego (void)

{

    do_nego();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_nego_64 (void)

{

    do_nego_64();

    RETURN();

}

#endif

/* subtract from carrying */

void OPPROTO op_check_subfc (void)

{

    if (likely((uint32_t)T0 > (uint32_t)T1)) {

        xer_ca = 0;

    } else {

        xer_ca = 1;

    }

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_check_subfc_64 (void)

{

    if (likely((uint64_t)T0 > (uint64_t)T1)) {

        xer_ca = 0;

    } else {

        xer_ca = 1;

    }

    RETURN();

}

#endif

/* subtract from extended */

void OPPROTO op_subfe (void)

{

    do_subfe();

    RETURN();

}

#if defined(TARGET_PPC64)

void OPPROTO op_subfe_64 (void)

{

    do_subfe_64();

    RETURN();

}

#endif

/* subtract from immediate carrying */

void OPPROTO op_subfic (void)

{

    T0 = (int32_t)PARAM1 + ~T0 + 1;

    if ((uint32_t)T0 <= (uint32_t)PARAM1) {

        xer_ca = 1;

    } else {

        xer_ca = 0;

    }