[qemu.git] / target-arm / op.c

/*
 *  ARM micro operations
 * 
 *  Copyright (c) 2003 Fabrice Bellard
 *  Copyright (c) 2005 CodeSourcery, LLC
 *
 * 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 "exec.h"

#define REGNAME r0
#define REG (env->regs[0])
#include "op_template.h"

#define REGNAME r1
#define REG (env->regs[1])
#include "op_template.h"

#define REGNAME r2
#define REG (env->regs[2])
#include "op_template.h"

#define REGNAME r3
#define REG (env->regs[3])
#include "op_template.h"

#define REGNAME r4
#define REG (env->regs[4])
#include "op_template.h"

#define REGNAME r5
#define REG (env->regs[5])
#include "op_template.h"

#define REGNAME r6
#define REG (env->regs[6])
#include "op_template.h"

#define REGNAME r7
#define REG (env->regs[7])
#include "op_template.h"

#define REGNAME r8
#define REG (env->regs[8])
#include "op_template.h"

#define REGNAME r9
#define REG (env->regs[9])
#include "op_template.h"

#define REGNAME r10
#define REG (env->regs[10])
#include "op_template.h"

#define REGNAME r11
#define REG (env->regs[11])
#include "op_template.h"

#define REGNAME r12
#define REG (env->regs[12])
#include "op_template.h"

#define REGNAME r13
#define REG (env->regs[13])
#include "op_template.h"

#define REGNAME r14
#define REG (env->regs[14])
#include "op_template.h"

#define REGNAME r15
#define REG (env->regs[15])
#define SET_REG(x) REG = x & ~(uint32_t)1
#include "op_template.h"

void OPPROTO op_bx_T0(void)
{
  env->regs[15] = T0 & ~(uint32_t)1;
  env->thumb = (T0 & 1) != 0;
}

void OPPROTO op_movl_T0_0(void)
{
    T0 = 0;
}

void OPPROTO op_movl_T0_im(void)
{
    T0 = PARAM1;
}

void OPPROTO op_movl_T1_im(void)
{
    T1 = PARAM1;
}

void OPPROTO op_mov_CF_T1(void)
{
    env->CF = ((uint32_t)T1) >> 31;
}

void OPPROTO op_movl_T2_im(void)
{
    T2 = PARAM1;
}

void OPPROTO op_addl_T1_im(void)
{
    T1 += PARAM1;
}

void OPPROTO op_addl_T1_T2(void)
{
    T1 += T2;
}

void OPPROTO op_subl_T1_T2(void)
{
    T1 -= T2;
}

void OPPROTO op_addl_T0_T1(void)
{
    T0 += T1;
}

void OPPROTO op_addl_T0_T1_cc(void)
{
    unsigned int src1;
    src1 = T0;
    T0 += T1;
    env->NZF = T0;
    env->CF = T0 < src1;
    env->VF = (src1 ^ T1 ^ -1) & (src1 ^ T0);
}

void OPPROTO op_adcl_T0_T1(void)
{
    T0 += T1 + env->CF;
}

void OPPROTO op_adcl_T0_T1_cc(void)
{
    unsigned int src1;
    src1 = T0;
    if (!env->CF) {
        T0 += T1;
        env->CF = T0 < src1;
    } else {
        T0 += T1 + 1;
        env->CF = T0 <= src1;
    }
    env->VF = (src1 ^ T1 ^ -1) & (src1 ^ T0);
    env->NZF = T0;
    FORCE_RET();
}

#define OPSUB(sub, sbc, res, T0, T1)            \
                                                \
void OPPROTO op_ ## sub ## l_T0_T1(void)        \
{                                               \
    res = T0 - T1;                              \
}                                               \
                                                \
void OPPROTO op_ ## sub ## l_T0_T1_cc(void)     \
{                                               \
    unsigned int src1;                          \
    src1 = T0;                                  \
    T0 -= T1;                                   \
    env->NZF = T0;                              \
    env->CF = src1 >= T1;                       \
    env->VF = (src1 ^ T1) & (src1 ^ T0);        \
    res = T0;                                   \
}                                               \
                                                \
void OPPROTO op_ ## sbc ## l_T0_T1(void)        \
{                                               \
    res = T0 - T1 + env->CF - 1;                \
}                                               \
                                                \
void OPPROTO op_ ## sbc ## l_T0_T1_cc(void)     \
{                                               \
    unsigned int src1;                          \
    src1 = T0;                                  \
    if (!env->CF) {                             \
        T0 = T0 - T1 - 1;                       \
        env->CF = src1 > T1;                    \
    } else {                                    \
        T0 = T0 - T1;                           \
        env->CF = src1 >= T1;                   \
    }                                           \
    env->VF = (src1 ^ T1) & (src1 ^ T0);        \
    env->NZF = T0;                              \
    res = T0;                                   \
    FORCE_RET();                                \
}

OPSUB(sub, sbc, T0, T0, T1)

OPSUB(rsb, rsc, T0, T1, T0)

void OPPROTO op_andl_T0_T1(void)
{
    T0 &= T1;
}

void OPPROTO op_xorl_T0_T1(void)
{
    T0 ^= T1;
}

void OPPROTO op_orl_T0_T1(void)
{
    T0 |= T1;
}

void OPPROTO op_bicl_T0_T1(void)
{
    T0 &= ~T1;
}

void OPPROTO op_notl_T1(void)
{
    T1 = ~T1;
}

void OPPROTO op_logic_T0_cc(void)
{
    env->NZF = T0;
}

void OPPROTO op_logic_T1_cc(void)
{
    env->NZF = T1;
}

#define EIP (env->regs[15])

void OPPROTO op_test_eq(void)
{
    if (env->NZF == 0)
        JUMP_TB(op_test_eq, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_ne(void)
{
    if (env->NZF != 0)
        JUMP_TB(op_test_ne, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_cs(void)
{
    if (env->CF != 0)
        JUMP_TB(op_test_cs, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_cc(void)
{
    if (env->CF == 0)
        JUMP_TB(op_test_cc, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_mi(void)
{
    if ((env->NZF & 0x80000000) != 0)
        JUMP_TB(op_test_mi, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_pl(void)
{
    if ((env->NZF & 0x80000000) == 0)
        JUMP_TB(op_test_pl, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_vs(void)
{
    if ((env->VF & 0x80000000) != 0)
        JUMP_TB(op_test_vs, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_vc(void)
{
    if ((env->VF & 0x80000000) == 0)
        JUMP_TB(op_test_vc, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_hi(void)
{
    if (env->CF != 0 && env->NZF != 0)
        JUMP_TB(op_test_hi, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_ls(void)
{
    if (env->CF == 0 || env->NZF == 0)
        JUMP_TB(op_test_ls, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_ge(void)
{
    if (((env->VF ^ env->NZF) & 0x80000000) == 0)
        JUMP_TB(op_test_ge, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_lt(void)
{
    if (((env->VF ^ env->NZF) & 0x80000000) != 0)
        JUMP_TB(op_test_lt, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_gt(void)
{
    if (env->NZF != 0 && ((env->VF ^ env->NZF) & 0x80000000) == 0)
        JUMP_TB(op_test_gt, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_test_le(void)
{
    if (env->NZF == 0 || ((env->VF ^ env->NZF) & 0x80000000) != 0)
        JUMP_TB(op_test_le, PARAM1, 0, PARAM2);
    FORCE_RET();
}

void OPPROTO op_jmp(void)
{
    JUMP_TB(op_jmp, PARAM1, 1, PARAM2);
}

void OPPROTO op_exit_tb(void)
{
    EXIT_TB();
}

void OPPROTO op_movl_T0_psr(void)
{
    T0 = compute_cpsr();
}

/* NOTE: N = 1 and Z = 1 cannot be stored currently */
void OPPROTO op_movl_psr_T0(void)
{
    unsigned int psr;
    psr = T0;
    env->CF = (psr >> 29) & 1;
    env->NZF = (psr & 0xc0000000) ^ 0x40000000;
    env->VF = (psr << 3) & 0x80000000;
    /* for user mode we do not update other state info */
}

void OPPROTO op_mul_T0_T1(void)
{
    T0 = T0 * T1;
}

/* 64 bit unsigned mul */
void OPPROTO op_mull_T0_T1(void)
{
    uint64_t res;
    res = (uint64_t)T0 * (uint64_t)T1;
    T1 = res >> 32;
    T0 = res;
}

/* 64 bit signed mul */
void OPPROTO op_imull_T0_T1(void)
{
    uint64_t res;
    res = (int64_t)((int32_t)T0) * (int64_t)((int32_t)T1);
    T1 = res >> 32;
    T0 = res;
}

/* 48 bit signed mul, top 32 bits */
void OPPROTO op_imulw_T0_T1(void)
{
  uint64_t res;
  res = (int64_t)((int32_t)T0) * (int64_t)((int32_t)T1);
  T0 = res >> 16;
}

void OPPROTO op_addq_T0_T1(void)
{
    uint64_t res;
    res = ((uint64_t)T1 << 32) | T0;
    res += ((uint64_t)(env->regs[PARAM2]) << 32) | (env->regs[PARAM1]);
    T1 = res >> 32;
    T0 = res;
}

void OPPROTO op_addq_lo_T0_T1(void)
{
    uint64_t res;
    res = ((uint64_t)T1 << 32) | T0;
    res += (uint64_t)(env->regs[PARAM1]);
    T1 = res >> 32;
    T0 = res;
}

void OPPROTO op_logicq_cc(void)
{
    env->NZF = (T1 & 0x80000000) | ((T0 | T1) != 0);
}

/* memory access */

void OPPROTO op_ldub_T0_T1(void)
{
    T0 = ldub((void *)T1);
}

void OPPROTO op_ldsb_T0_T1(void)
{
    T0 = ldsb((void *)T1);
}

void OPPROTO op_lduw_T0_T1(void)
{
    T0 = lduw((void *)T1);
}

void OPPROTO op_ldsw_T0_T1(void)
{
    T0 = ldsw((void *)T1);
}

void OPPROTO op_ldl_T0_T1(void)
{
    T0 = ldl((void *)T1);
}

void OPPROTO op_stb_T0_T1(void)
{
    stb((void *)T1, T0);
}

void OPPROTO op_stw_T0_T1(void)
{
    stw((void *)T1, T0);
}

void OPPROTO op_stl_T0_T1(void)
{
    stl((void *)T1, T0);
}

void OPPROTO op_swpb_T0_T1(void)
{
    int tmp;

    cpu_lock();
    tmp = ldub((void *)T1);
    stb((void *)T1, T0);
    T0 = tmp;
    cpu_unlock();
}

void OPPROTO op_swpl_T0_T1(void)
{
    int tmp;

    cpu_lock();
    tmp = ldl((void *)T1);
    stl((void *)T1, T0);
    T0 = tmp;
    cpu_unlock();
}

/* shifts */

/* T1 based */

void OPPROTO op_shll_T1_im(void)
{
    T1 = T1 << PARAM1;
}

void OPPROTO op_shrl_T1_im(void)
{
    T1 = (uint32_t)T1 >> PARAM1;
}

void OPPROTO op_shrl_T1_0(void)
{
    T1 = 0;
}

void OPPROTO op_sarl_T1_im(void)
{
    T1 = (int32_t)T1 >> PARAM1;
}

void OPPROTO op_sarl_T1_0(void)
{
    T1 = (int32_t)T1 >> 31;
}

void OPPROTO op_rorl_T1_im(void)
{
    int shift;
    shift = PARAM1;
    T1 = ((uint32_t)T1 >> shift) | (T1 << (32 - shift));
}

void OPPROTO op_rrxl_T1(void)
{
    T1 = ((uint32_t)T1 >> 1) | ((uint32_t)env->CF << 31);
}

/* T1 based, set C flag */
void OPPROTO op_shll_T1_im_cc(void)
{
    env->CF = (T1 >> (32 - PARAM1)) & 1;
    T1 = T1 << PARAM1;
}

void OPPROTO op_shrl_T1_im_cc(void)
{
    env->CF = (T1 >> (PARAM1 - 1)) & 1;
    T1 = (uint32_t)T1 >> PARAM1;
}

void OPPROTO op_shrl_T1_0_cc(void)
{
    env->CF = (T1 >> 31) & 1;
    T1 = 0;
}

void OPPROTO op_sarl_T1_im_cc(void)
{
    env->CF = (T1 >> (PARAM1 - 1)) & 1;
    T1 = (int32_t)T1 >> PARAM1;
}

void OPPROTO op_sarl_T1_0_cc(void)
{
    env->CF = (T1 >> 31) & 1;
    T1 = (int32_t)T1 >> 31;
}

void OPPROTO op_rorl_T1_im_cc(void)
{
    int shift;
    shift = PARAM1;
    env->CF = (T1 >> (shift - 1)) & 1;
    T1 = ((uint32_t)T1 >> shift) | (T1 << (32 - shift));
}

void OPPROTO op_rrxl_T1_cc(void)
{
    uint32_t c;
    c = T1 & 1;
    T1 = ((uint32_t)T1 >> 1) | ((uint32_t)env->CF << 31);
    env->CF = c;
}

/* T2 based */
void OPPROTO op_shll_T2_im(void)
{
    T2 = T2 << PARAM1;
}

void OPPROTO op_shrl_T2_im(void)
{
    T2 = (uint32_t)T2 >> PARAM1;
}

void OPPROTO op_shrl_T2_0(void)
{
    T2 = 0;
}

void OPPROTO op_sarl_T2_im(void)
{
    T2 = (int32_t)T2 >> PARAM1;
}

void OPPROTO op_sarl_T2_0(void)
{
    T2 = (int32_t)T2 >> 31;
}

void OPPROTO op_rorl_T2_im(void)
{
    int shift;
    shift = PARAM1;
    T2 = ((uint32_t)T2 >> shift) | (T2 << (32 - shift));
}

void OPPROTO op_rrxl_T2(void)
{
    T2 = ((uint32_t)T2 >> 1) | ((uint32_t)env->CF << 31);
}

/* T1 based, use T0 as shift count */

void OPPROTO op_shll_T1_T0(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32)
        T1 = 0;
    else
        T1 = T1 << shift;
    FORCE_RET();
}

void OPPROTO op_shrl_T1_T0(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32)
        T1 = 0;
    else
        T1 = (uint32_t)T1 >> shift;
    FORCE_RET();
}

void OPPROTO op_sarl_T1_T0(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32)
        shift = 31;
    T1 = (int32_t)T1 >> shift;
}

void OPPROTO op_rorl_T1_T0(void)
{
    int shift;
    shift = T0 & 0x1f;
    if (shift) {
        T1 = ((uint32_t)T1 >> shift) | (T1 << (32 - shift));
    }
    FORCE_RET();
}

/* T1 based, use T0 as shift count and compute CF */

void OPPROTO op_shll_T1_T0_cc(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32) {
        if (shift == 32)
            env->CF = T1 & 1;
        else
            env->CF = 0;
        T1 = 0;
    } else if (shift != 0) {
        env->CF = (T1 >> (32 - shift)) & 1;
        T1 = T1 << shift;
    }
    FORCE_RET();
}

void OPPROTO op_shrl_T1_T0_cc(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32) {
        if (shift == 32)
            env->CF = (T1 >> 31) & 1;
        else
            env->CF = 0;
        T1 = 0;
    } else if (shift != 0) {
        env->CF = (T1 >> (shift - 1)) & 1;
        T1 = (uint32_t)T1 >> shift;
    }
    FORCE_RET();
}

void OPPROTO op_sarl_T1_T0_cc(void)
{
    int shift;
    shift = T0 & 0xff;
    if (shift >= 32) {
        env->CF = (T1 >> 31) & 1;
        T1 = (int32_t)T1 >> 31;
    } else {
        env->CF = (T1 >> (shift - 1)) & 1;
        T1 = (int32_t)T1 >> shift;
    }
    FORCE_RET();
}

void OPPROTO op_rorl_T1_T0_cc(void)
{
    int shift1, shift;
    shift1 = T0 & 0xff;
    shift = shift1 & 0x1f;
    if (shift == 0) {
        if (shift1 != 0)
            env->CF = (T1 >> 31) & 1;
    } else {
        env->CF = (T1 >> (shift - 1)) & 1;
        T1 = ((uint32_t)T1 >> shift) | (T1 << (32 - shift));
    }
    FORCE_RET();
}

/* misc */
void OPPROTO op_clz_T0(void)
{
    int count;
    for (count = 32; T0 > 0; count--)
        T0 = T0 >> 1;
    T0 = count;
    FORCE_RET();
}

void OPPROTO op_sarl_T0_im(void)
{
    T0 = (int32_t)T0 >> PARAM1;
}

/* 16->32 Sign extend */
void OPPROTO op_sxl_T0(void)
{
  T0 = (int16_t)T0;
}

void OPPROTO op_sxl_T1(void)
{
  T1 = (int16_t)T1;
}

#define SIGNBIT (uint32_t)0x80000000
/* saturating arithmetic  */
void OPPROTO op_addl_T0_T1_setq(void)
{
  uint32_t res;

  res = T0 + T1;
  if (((res ^ T0) & SIGNBIT) && !((T0 ^ T1) & SIGNBIT))
      env->QF = 1;

  T0 = res;
  FORCE_RET();
}

void OPPROTO op_addl_T0_T1_saturate(void)
{
  uint32_t res;

  res = T0 + T1;
  if (((res ^ T0) & SIGNBIT) && !((T0 ^ T1) & SIGNBIT)) {
      env->QF = 1;
      if (T0 & SIGNBIT)
          T0 = 0x80000000;
      else
          T0 = 0x7fffffff;
  }
  else
    T0 = res;
  
  FORCE_RET();
}

void OPPROTO op_subl_T0_T1_saturate(void)
{
  uint32_t res;

  res = T0 - T1;
  if (((res ^ T0) & SIGNBIT) && ((T0 ^ T1) & SIGNBIT)) {
      env->QF = 1;
      if (T0 & SIGNBIT)
          T0 = 0x8000000;
      else
          T0 = 0x7fffffff;
  }
  else
    T0 = res;
  
  FORCE_RET();
}

/* thumb shift by immediate */
void OPPROTO op_shll_T0_im_thumb(void)
{
    int shift;
    shift = PARAM1;
    if (shift != 0) {
	env->CF = (T1 >> (32 - shift)) & 1;
	T0 = T0 << shift;
    }
    env->NZF = T0;
    FORCE_RET();
}

void OPPROTO op_shrl_T0_im_thumb(void)
{
    int shift;

    shift = PARAM1;
    if (shift == 0) {
	env->CF = 0;
	T0 = 0;
    } else {
	env->CF = (T0 >> (shift - 1)) & 1;
	T0 = T0 >> shift;
    }
    FORCE_RET();
}

void OPPROTO op_sarl_T0_im_thumb(void)
{
    int shift;

    shift = PARAM1;
    if (shift == 0) {
	T0 = ((int32_t)T0) >> 31;
	env->CF = T0 & 1;
    } else {
	env->CF = (T0 >> (shift - 1)) & 1;
	T0 = ((int32_t)T0) >> shift;
    }
    env->NZF = T0;
    FORCE_RET();
}

/* exceptions */

void OPPROTO op_swi(void)
{
    env->exception_index = EXCP_SWI;
    cpu_loop_exit();
}

void OPPROTO op_undef_insn(void)
{
    env->exception_index = EXCP_UDEF;
    cpu_loop_exit();
}

/* VFP support.  We follow the convention used for VFP instrunctions:
   Single precition routines have a "s" suffix, double precision a
   "d" suffix.  */

#define VFP_OP(name, p) void OPPROTO op_vfp_##name##p(void)

#define VFP_BINOP(name, op) \
VFP_OP(name, s)             \
{                           \
    FT0s = FT0s op FT1s;    \
}                           \
VFP_OP(name, d)             \
{                           \
    FT0d = FT0d op FT1d;    \
}
VFP_BINOP(add, +)
VFP_BINOP(sub, -)
VFP_BINOP(mul, *)
VFP_BINOP(div, /)
#undef VFP_BINOP

#define VFP_HELPER(name)  \
VFP_OP(name, s)           \
{                         \
    do_vfp_##name##s();    \
}                         \
VFP_OP(name, d)           \
{                         \
    do_vfp_##name##d();    \
}
VFP_HELPER(abs)
VFP_HELPER(sqrt)
VFP_HELPER(cmp)
VFP_HELPER(cmpe)
#undef VFP_HELPER

/* XXX: Will this do the right thing for NANs.  Should invert the signbit
   without looking at the rest of the value.  */
VFP_OP(neg, s)
{
    FT0s = -FT0s;
}

VFP_OP(neg, d)
{
    FT0d = -FT0d;
}

VFP_OP(F1_ld0, s)
{
    FT1s = 0.0f;
}

VFP_OP(F1_ld0, d)
{
    FT1d = 0.0;
}

/* Helper routines to perform bitwise copies between float and int.  */
static inline float vfp_itos(uint32_t i)
{
    union {
        uint32_t i;
        float s;
    } v;

    v.i = i;
    return v.s;
}

static inline uint32_t vfp_stoi(float s)
{
    union {
        uint32_t i;
        float s;
    } v;

    v.s = s;
    return v.i;
}

/* Integer to float conversion.  */
VFP_OP(uito, s)
{
    FT0s = (float)(uint32_t)vfp_stoi(FT0s);
}

VFP_OP(uito, d)
{
    FT0d = (double)(uint32_t)vfp_stoi(FT0s);
}

VFP_OP(sito, s)
{
    FT0s = (float)(int32_t)vfp_stoi(FT0s);
}

VFP_OP(sito, d)
{
    FT0d = (double)(int32_t)vfp_stoi(FT0s);
}

/* Float to integer conversion.  */
VFP_OP(toui, s)
{
    FT0s = vfp_itos((uint32_t)FT0s);
}

VFP_OP(toui, d)
{
    FT0s = vfp_itos((uint32_t)FT0d);
}

VFP_OP(tosi, s)
{
    FT0s = vfp_itos((int32_t)FT0s);
}

VFP_OP(tosi, d)
{
    FT0s = vfp_itos((int32_t)FT0d);
}

/* TODO: Set rounding mode properly.  */
VFP_OP(touiz, s)
{
    FT0s = vfp_itos((uint32_t)FT0s);
}

VFP_OP(touiz, d)
{
    FT0s = vfp_itos((uint32_t)FT0d);
}

VFP_OP(tosiz, s)
{
    FT0s = vfp_itos((int32_t)FT0s);
}

VFP_OP(tosiz, d)
{
    FT0s = vfp_itos((int32_t)FT0d);
}

/* floating point conversion */
VFP_OP(fcvtd, s)
{
    FT0d = (double)FT0s;
}

VFP_OP(fcvts, d)
{
    FT0s = (float)FT0d;
}

/* Get and Put values from registers.  */
VFP_OP(getreg_F0, d)
{
  FT0d = *(double *)((char *) env + PARAM1);
}

VFP_OP(getreg_F0, s)
{
  FT0s = *(float *)((char *) env + PARAM1);
}

VFP_OP(getreg_F1, d)
{
  FT1d = *(double *)((char *) env + PARAM1);
}

VFP_OP(getreg_F1, s)
{
  FT1s = *(float *)((char *) env + PARAM1);
}

VFP_OP(setreg_F0, d)
{
  *(double *)((char *) env + PARAM1) = FT0d;
}

VFP_OP(setreg_F0, s)
{
  *(float *)((char *) env + PARAM1) = FT0s;
}

VFP_OP(foobar, d)
{
  FT0d = env->vfp.regs.s[3];
}

void OPPROTO op_vfp_movl_T0_fpscr(void)
{
    do_vfp_get_fpscr ();
}

void OPPROTO op_vfp_movl_T0_fpscr_flags(void)
{
    T0 = env->vfp.fpscr & (0xf << 28);
}

void OPPROTO op_vfp_movl_fpscr_T0(void)
{
    do_vfp_set_fpscr();
}

/* Move between FT0s to T0  */
void OPPROTO op_vfp_mrs(void)
{
    T0 = vfp_stoi(FT0s);
}

void OPPROTO op_vfp_msr(void)
{
    FT0s = vfp_itos(T0);
}

/* Move between FT0d and {T0,T1} */
void OPPROTO op_vfp_mrrd(void)
{
    CPU_DoubleU u;
    
    u.d = FT0d;
    T0 = u.l.lower;
    T1 = u.l.upper;
}

void OPPROTO op_vfp_mdrr(void)
{
    CPU_DoubleU u;
    
    u.l.lower = T0;
    u.l.upper = T1;
    FT0d = u.d;
}

/* Floating point load/store.  Address is in T1 */
void OPPROTO op_vfp_lds(void)
{
    FT0s = ldfl((void *)T1);
}

void OPPROTO op_vfp_ldd(void)
{
    FT0d = ldfq((void *)T1);
}

void OPPROTO op_vfp_sts(void)
{
    stfl((void *)T1, FT0s);
}

void OPPROTO op_vfp_std(void)
{
    stfq((void *)T1, FT0d);
}
Commit	Line	Data
2c0262af FB	1	/*
	2	* ARM micro operations
	3	*
	4	* Copyright (c) 2003 Fabrice Bellard
b7bcbe95	5	* Copyright (c) 2005 CodeSourcery, LLC
2c0262af FB	6	*
	7	* This library is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU Lesser General Public
	9	* License as published by the Free Software Foundation; either
	10	* version 2 of the License, or (at your option) any later version.
	11	*
	12	* This library 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 GNU
	15	* Lesser General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU Lesser General Public
	18	* License along with this library; if not, write to the Free Software
	19	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	20	*/
	21	#include "exec.h"
	22
	23	#define REGNAME r0
	24	#define REG (env->regs[0])
	25	#include "op_template.h"
	26
	27	#define REGNAME r1
	28	#define REG (env->regs[1])
	29	#include "op_template.h"
	30
	31	#define REGNAME r2
	32	#define REG (env->regs[2])
	33	#include "op_template.h"
	34
	35	#define REGNAME r3
	36	#define REG (env->regs[3])
	37	#include "op_template.h"
	38
	39	#define REGNAME r4
	40	#define REG (env->regs[4])
	41	#include "op_template.h"
	42
	43	#define REGNAME r5
	44	#define REG (env->regs[5])
	45	#include "op_template.h"
	46
	47	#define REGNAME r6
	48	#define REG (env->regs[6])
	49	#include "op_template.h"
	50
	51	#define REGNAME r7
	52	#define REG (env->regs[7])
	53	#include "op_template.h"
	54
	55	#define REGNAME r8
	56	#define REG (env->regs[8])
	57	#include "op_template.h"
	58
	59	#define REGNAME r9
	60	#define REG (env->regs[9])
	61	#include "op_template.h"
	62
	63	#define REGNAME r10
	64	#define REG (env->regs[10])
	65	#include "op_template.h"
	66
	67	#define REGNAME r11
	68	#define REG (env->regs[11])
	69	#include "op_template.h"
70
71	#define REGNAME r12
72	#define REG (env->regs[12])
73	#include "op_template.h"
74
75	#define REGNAME r13
76	#define REG (env->regs[13])
77	#include "op_template.h"
78
79	#define REGNAME r14
80	#define REG (env->regs[14])
81	#include "op_template.h"
82
83	#define REGNAME r15
84	#define REG (env->regs[15])
99c475ab	85	#define SET_REG(x) REG = x & ~(uint32_t)1
2c0262af FB	86	#include "op_template.h"
2c0262af FB	87
99c475ab FB	88	void OPPROTO op_bx_T0(void)
	89	{
	90	env->regs[15] = T0 & ~(uint32_t)1;
	91	env->thumb = (T0 & 1) != 0;
	92	}
	93
2c0262af FB	94	void OPPROTO op_movl_T0_0(void)
	95	{
	96	T0 = 0;
	97	}
	98
	99	void OPPROTO op_movl_T0_im(void)
	100	{
	101	T0 = PARAM1;
	102	}
	103
	104	void OPPROTO op_movl_T1_im(void)
	105	{
	106	T1 = PARAM1;
	107	}
	108
7ff4d218 FB	109	void OPPROTO op_mov_CF_T1(void)
	110	{
	111	env->CF = ((uint32_t)T1) >> 31;
	112	}
	113
2c0262af FB	114	void OPPROTO op_movl_T2_im(void)
	115	{
	116	T2 = PARAM1;
	117	}
	118
	119	void OPPROTO op_addl_T1_im(void)
	120	{
	121	T1 += PARAM1;
	122	}
	123
	124	void OPPROTO op_addl_T1_T2(void)
	125	{
	126	T1 += T2;
	127	}
	128
	129	void OPPROTO op_subl_T1_T2(void)
	130	{
	131	T1 -= T2;
	132	}
	133
	134	void OPPROTO op_addl_T0_T1(void)
	135	{
	136	T0 += T1;
	137	}
	138
	139	void OPPROTO op_addl_T0_T1_cc(void)
	140	{
	141	unsigned int src1;
	142	src1 = T0;
	143	T0 += T1;
	144	env->NZF = T0;
	145	env->CF = T0 < src1;
	146	env->VF = (src1 ^ T1 ^ -1) & (src1 ^ T0);
	147	}
	148
	149	void OPPROTO op_adcl_T0_T1(void)
	150	{
	151	T0 += T1 + env->CF;
	152	}
	153
	154	void OPPROTO op_adcl_T0_T1_cc(void)
	155	{
	156	unsigned int src1;
	157	src1 = T0;
	158	if (!env->CF) {
	159	T0 += T1;
	160	env->CF = T0 < src1;
	161	} else {
	162	T0 += T1 + 1;
	163	env->CF = T0 <= src1;
	164	}
	165	env->VF = (src1 ^ T1 ^ -1) & (src1 ^ T0);
	166	env->NZF = T0;
	167	FORCE_RET();
	168	}
	169
	170	#define OPSUB(sub, sbc, res, T0, T1) \
	171	\
	172	void OPPROTO op_ ## sub ## l_T0_T1(void) \
	173	{ \
	174	res = T0 - T1; \
	175	} \
	176	\
	177	void OPPROTO op_ ## sub ## l_T0_T1_cc(void) \
178	{ \
179	unsigned int src1; \
180	src1 = T0; \
181	T0 -= T1; \
182	env->NZF = T0; \
183	env->CF = src1 >= T1; \
184	env->VF = (src1 ^ T1) & (src1 ^ T0); \
185	res = T0; \
186	} \
187	\
188	void OPPROTO op_ ## sbc ## l_T0_T1(void) \
189	{ \
190	res = T0 - T1 + env->CF - 1; \
191	} \
192	\
193	void OPPROTO op_ ## sbc ## l_T0_T1_cc(void) \
194	{ \
195	unsigned int src1; \
196	src1 = T0; \
197	if (!env->CF) { \
198	T0 = T0 - T1 - 1; \
78573df6	199	env->CF = src1 > T1; \
2c0262af FB	200	} else { \
2c0262af FB	201	T0 = T0 - T1; \
78573df6	202	env->CF = src1 >= T1; \
2c0262af FB	203	} \
	204	env->VF = (src1 ^ T1) & (src1 ^ T0); \
	205	env->NZF = T0; \
	206	res = T0; \
	207	FORCE_RET(); \
	208	}
	209
	210	OPSUB(sub, sbc, T0, T0, T1)
	211
	212	OPSUB(rsb, rsc, T0, T1, T0)
	213
	214	void OPPROTO op_andl_T0_T1(void)
	215	{
	216	T0 &= T1;
	217	}
	218
	219	void OPPROTO op_xorl_T0_T1(void)
	220	{
	221	T0 ^= T1;
	222	}
	223
	224	void OPPROTO op_orl_T0_T1(void)
	225	{
	226	T0 \|= T1;
	227	}
	228
	229	void OPPROTO op_bicl_T0_T1(void)
	230	{
	231	T0 &= ~T1;
	232	}
	233
	234	void OPPROTO op_notl_T1(void)
	235	{
	236	T1 = ~T1;
	237	}
	238
	239	void OPPROTO op_logic_T0_cc(void)
	240	{
	241	env->NZF = T0;
	242	}
	243
	244	void OPPROTO op_logic_T1_cc(void)
	245	{
	246	env->NZF = T1;
	247	}
	248
	249	#define EIP (env->regs[15])
	250
	251	void OPPROTO op_test_eq(void)
	252	{
	253	if (env->NZF == 0)
	254	JUMP_TB(op_test_eq, PARAM1, 0, PARAM2);
	255	FORCE_RET();
	256	}
	257
	258	void OPPROTO op_test_ne(void)
	259	{
	260	if (env->NZF != 0)
	261	JUMP_TB(op_test_ne, PARAM1, 0, PARAM2);
	262	FORCE_RET();
	263	}
	264
	265	void OPPROTO op_test_cs(void)
	266	{
267	if (env->CF != 0)
268	JUMP_TB(op_test_cs, PARAM1, 0, PARAM2);
269	FORCE_RET();
270	}
271
272	void OPPROTO op_test_cc(void)
273	{
274	if (env->CF == 0)
275	JUMP_TB(op_test_cc, PARAM1, 0, PARAM2);
276	FORCE_RET();
277	}
278
279	void OPPROTO op_test_mi(void)
280	{
281	if ((env->NZF & 0x80000000) != 0)
282	JUMP_TB(op_test_mi, PARAM1, 0, PARAM2);
283	FORCE_RET();
284	}
285
286	void OPPROTO op_test_pl(void)
287	{
288	if ((env->NZF & 0x80000000) == 0)
289	JUMP_TB(op_test_pl, PARAM1, 0, PARAM2);
290	FORCE_RET();
291	}
292
293	void OPPROTO op_test_vs(void)
294	{
295	if ((env->VF & 0x80000000) != 0)
296	JUMP_TB(op_test_vs, PARAM1, 0, PARAM2);
297	FORCE_RET();
298	}
299
300	void OPPROTO op_test_vc(void)
301	{
302	if ((env->VF & 0x80000000) == 0)
303	JUMP_TB(op_test_vc, PARAM1, 0, PARAM2);
304	FORCE_RET();
305	}
306
307	void OPPROTO op_test_hi(void)
308	{
309	if (env->CF != 0 && env->NZF != 0)
310	JUMP_TB(op_test_hi, PARAM1, 0, PARAM2);
311	FORCE_RET();
312	}
313
314	void OPPROTO op_test_ls(void)
315	{
316	if (env->CF == 0 \|\| env->NZF == 0)
317	JUMP_TB(op_test_ls, PARAM1, 0, PARAM2);
318	FORCE_RET();
319	}
320
321	void OPPROTO op_test_ge(void)
322	{
323	if (((env->VF ^ env->NZF) & 0x80000000) == 0)
324	JUMP_TB(op_test_ge, PARAM1, 0, PARAM2);
325	FORCE_RET();
326	}
327
328	void OPPROTO op_test_lt(void)
329	{
330	if (((env->VF ^ env->NZF) & 0x80000000) != 0)
331	JUMP_TB(op_test_lt, PARAM1, 0, PARAM2);
332	FORCE_RET();
333	}
334
335	void OPPROTO op_test_gt(void)
336	{
337	if (env->NZF != 0 && ((env->VF ^ env->NZF) & 0x80000000) == 0)
338	JUMP_TB(op_test_gt, PARAM1, 0, PARAM2);
339	FORCE_RET();
340	}
341
342	void OPPROTO op_test_le(void)
343	{
344	if (env->NZF == 0 \|\| ((env->VF ^ env->NZF) & 0x80000000) != 0)
345	JUMP_TB(op_test_le, PARAM1, 0, PARAM2);
346	FORCE_RET();
347	}
348
349	void OPPROTO op_jmp(void)
350	{
351	JUMP_TB(op_jmp, PARAM1, 1, PARAM2);
352	}
353
354	void OPPROTO op_exit_tb(void)
355	{
356	EXIT_TB();
357	}
358
359	void OPPROTO op_movl_T0_psr(void)
360	{
361	T0 = compute_cpsr();
362	}
363
364	/* NOTE: N = 1 and Z = 1 cannot be stored currently */
365	void OPPROTO op_movl_psr_T0(void)
366	{
367	unsigned int psr;
368	psr = T0;
369	env->CF = (psr >> 29) & 1;
370	env->NZF = (psr & 0xc0000000) ^ 0x40000000;
371	env->VF = (psr << 3) & 0x80000000;
372	/* for user mode we do not update other state info */
373	}
374
375	void OPPROTO op_mul_T0_T1(void)
376	{
377	T0 = T0 * T1;
378	}
379
380	/* 64 bit unsigned mul */
381	void OPPROTO op_mull_T0_T1(void)
382	{
383	uint64_t res;
2e134c9c	384	res = (uint64_t)T0 * (uint64_t)T1;
2c0262af FB	385	T1 = res >> 32;
	386	T0 = res;
	387	}
	388
	389	/* 64 bit signed mul */
	390	void OPPROTO op_imull_T0_T1(void)
	391	{
	392	uint64_t res;
163a7cb6	393	res = (int64_t)((int32_t)T0) * (int64_t)((int32_t)T1);
2c0262af FB	394	T1 = res >> 32;
	395	T0 = res;
	396	}
	397
99c475ab FB	398	/* 48 bit signed mul, top 32 bits */
	399	void OPPROTO op_imulw_T0_T1(void)
	400	{
	401	uint64_t res;
	402	res = (int64_t)((int32_t)T0) * (int64_t)((int32_t)T1);
	403	T0 = res >> 16;
	404	}
	405
2c0262af FB	406	void OPPROTO op_addq_T0_T1(void)
	407	{
	408	uint64_t res;
	409	res = ((uint64_t)T1 << 32) \| T0;
	410	res += ((uint64_t)(env->regs[PARAM2]) << 32) \| (env->regs[PARAM1]);
	411	T1 = res >> 32;
	412	T0 = res;
	413	}
	414
99c475ab FB	415	void OPPROTO op_addq_lo_T0_T1(void)
	416	{
	417	uint64_t res;
	418	res = ((uint64_t)T1 << 32) \| T0;
	419	res += (uint64_t)(env->regs[PARAM1]);
	420	T1 = res >> 32;
	421	T0 = res;
	422	}
	423
2c0262af FB	424	void OPPROTO op_logicq_cc(void)
	425	{
	426	env->NZF = (T1 & 0x80000000) \| ((T0 \| T1) != 0);
	427	}
	428
	429	/* memory access */
	430
	431	void OPPROTO op_ldub_T0_T1(void)
	432	{
	433	T0 = ldub((void *)T1);
	434	}
	435
	436	void OPPROTO op_ldsb_T0_T1(void)
	437	{
	438	T0 = ldsb((void *)T1);
	439	}
	440
	441	void OPPROTO op_lduw_T0_T1(void)
	442	{
	443	T0 = lduw((void *)T1);
	444	}
	445
	446	void OPPROTO op_ldsw_T0_T1(void)
	447	{
	448	T0 = ldsw((void *)T1);
	449	}
	450
	451	void OPPROTO op_ldl_T0_T1(void)
	452	{
	453	T0 = ldl((void *)T1);
	454	}
	455
	456	void OPPROTO op_stb_T0_T1(void)
	457	{
	458	stb((void *)T1, T0);
	459	}
	460
	461	void OPPROTO op_stw_T0_T1(void)
	462	{
	463	stw((void *)T1, T0);
	464	}
	465
	466	void OPPROTO op_stl_T0_T1(void)
	467	{
	468	stl((void *)T1, T0);
	469	}
	470
	471	void OPPROTO op_swpb_T0_T1(void)
	472	{
	473	int tmp;
	474
	475	cpu_lock();
	476	tmp = ldub((void *)T1);
	477	stb((void *)T1, T0);
	478	T0 = tmp;
	479	cpu_unlock();
	480	}
	481
	482	void OPPROTO op_swpl_T0_T1(void)
	483	{
	484	int tmp;
	485
	486	cpu_lock();
	487	tmp = ldl((void *)T1);
488	stl((void *)T1, T0);
489	T0 = tmp;
490	cpu_unlock();
491	}
492
493	/* shifts */
494
495	/* T1 based */
1e8d4eec	496
2c0262af FB	497	void OPPROTO op_shll_T1_im(void)
	498	{
	499	T1 = T1 << PARAM1;
	500	}
	501
	502	void OPPROTO op_shrl_T1_im(void)
	503	{
	504	T1 = (uint32_t)T1 >> PARAM1;
	505	}
	506
1e8d4eec FB	507	void OPPROTO op_shrl_T1_0(void)
	508	{
	509	T1 = 0;
	510	}
	511
2c0262af FB	512	void OPPROTO op_sarl_T1_im(void)
	513	{
	514	T1 = (int32_t)T1 >> PARAM1;
	515	}
	516
1e8d4eec FB	517	void OPPROTO op_sarl_T1_0(void)
	518	{
	519	T1 = (int32_t)T1 >> 31;
	520	}
	521
2c0262af FB	522	void OPPROTO op_rorl_T1_im(void)
	523	{
	524	int shift;
	525	shift = PARAM1;
	526	T1 = ((uint32_t)T1 >> shift) \| (T1 << (32 - shift));
	527	}
	528
88920f34 FB	529	void OPPROTO op_rrxl_T1(void)
	530	{
	531	T1 = ((uint32_t)T1 >> 1) \| ((uint32_t)env->CF << 31);
	532	}
	533
2c0262af FB	534	/* T1 based, set C flag */
	535	void OPPROTO op_shll_T1_im_cc(void)
	536	{
	537	env->CF = (T1 >> (32 - PARAM1)) & 1;
	538	T1 = T1 << PARAM1;
	539	}
	540
	541	void OPPROTO op_shrl_T1_im_cc(void)
	542	{
	543	env->CF = (T1 >> (PARAM1 - 1)) & 1;
	544	T1 = (uint32_t)T1 >> PARAM1;
	545	}
	546
1e8d4eec FB	547	void OPPROTO op_shrl_T1_0_cc(void)
	548	{
	549	env->CF = (T1 >> 31) & 1;
	550	T1 = 0;
	551	}
	552
2c0262af FB	553	void OPPROTO op_sarl_T1_im_cc(void)
	554	{
	555	env->CF = (T1 >> (PARAM1 - 1)) & 1;
	556	T1 = (int32_t)T1 >> PARAM1;
	557	}
	558
1e8d4eec FB	559	void OPPROTO op_sarl_T1_0_cc(void)
	560	{
	561	env->CF = (T1 >> 31) & 1;
	562	T1 = (int32_t)T1 >> 31;
	563	}
	564
2c0262af FB	565	void OPPROTO op_rorl_T1_im_cc(void)
	566	{
	567	int shift;
	568	shift = PARAM1;
	569	env->CF = (T1 >> (shift - 1)) & 1;
	570	T1 = ((uint32_t)T1 >> shift) \| (T1 << (32 - shift));
	571	}
	572
88920f34 FB	573	void OPPROTO op_rrxl_T1_cc(void)
	574	{
	575	uint32_t c;
	576	c = T1 & 1;
	577	T1 = ((uint32_t)T1 >> 1) \| ((uint32_t)env->CF << 31);
	578	env->CF = c;
	579	}
	580
2c0262af FB	581	/* T2 based */
	582	void OPPROTO op_shll_T2_im(void)
	583	{
	584	T2 = T2 << PARAM1;
	585	}
	586
	587	void OPPROTO op_shrl_T2_im(void)
	588	{
	589	T2 = (uint32_t)T2 >> PARAM1;
	590	}
	591
1e8d4eec FB	592	void OPPROTO op_shrl_T2_0(void)
	593	{
	594	T2 = 0;
	595	}
	596
2c0262af FB	597	void OPPROTO op_sarl_T2_im(void)
	598	{
	599	T2 = (int32_t)T2 >> PARAM1;
	600	}
	601
1e8d4eec FB	602	void OPPROTO op_sarl_T2_0(void)
	603	{
	604	T2 = (int32_t)T2 >> 31;
	605	}
	606
2c0262af FB	607	void OPPROTO op_rorl_T2_im(void)
	608	{
	609	int shift;
	610	shift = PARAM1;
	611	T2 = ((uint32_t)T2 >> shift) \| (T2 << (32 - shift));
	612	}
	613
1e8d4eec FB	614	void OPPROTO op_rrxl_T2(void)
	615	{
	616	T2 = ((uint32_t)T2 >> 1) \| ((uint32_t)env->CF << 31);
	617	}
	618
2c0262af FB	619	/* T1 based, use T0 as shift count */
	620
	621	void OPPROTO op_shll_T1_T0(void)
	622	{
	623	int shift;
	624	shift = T0 & 0xff;
	625	if (shift >= 32)
	626	T1 = 0;
	627	else
	628	T1 = T1 << shift;
	629	FORCE_RET();
	630	}
	631
	632	void OPPROTO op_shrl_T1_T0(void)
	633	{
	634	int shift;
	635	shift = T0 & 0xff;
	636	if (shift >= 32)
	637	T1 = 0;
	638	else
	639	T1 = (uint32_t)T1 >> shift;
	640	FORCE_RET();
	641	}
	642
	643	void OPPROTO op_sarl_T1_T0(void)
	644	{
	645	int shift;
	646	shift = T0 & 0xff;
	647	if (shift >= 32)
	648	shift = 31;
	649	T1 = (int32_t)T1 >> shift;
	650	}
	651
	652	void OPPROTO op_rorl_T1_T0(void)
	653	{
	654	int shift;
	655	shift = T0 & 0x1f;
	656	if (shift) {
	657	T1 = ((uint32_t)T1 >> shift) \| (T1 << (32 - shift));
	658	}
	659	FORCE_RET();
	660	}
	661
	662	/* T1 based, use T0 as shift count and compute CF */
	663
	664	void OPPROTO op_shll_T1_T0_cc(void)
	665	{
	666	int shift;
	667	shift = T0 & 0xff;
	668	if (shift >= 32) {
	669	if (shift == 32)
	670	env->CF = T1 & 1;
	671	else
	672	env->CF = 0;
	673	T1 = 0;
	674	} else if (shift != 0) {
	675	env->CF = (T1 >> (32 - shift)) & 1;
	676	T1 = T1 << shift;
	677	}
	678	FORCE_RET();
	679	}
	680
	681	void OPPROTO op_shrl_T1_T0_cc(void)
	682	{
683	int shift;
684	shift = T0 & 0xff;
685	if (shift >= 32) {
686	if (shift == 32)
687	env->CF = (T1 >> 31) & 1;
688	else
689	env->CF = 0;
690	T1 = 0;
691	} else if (shift != 0) {
692	env->CF = (T1 >> (shift - 1)) & 1;
693	T1 = (uint32_t)T1 >> shift;
694	}
695	FORCE_RET();
696	}
697
698	void OPPROTO op_sarl_T1_T0_cc(void)
699	{
700	int shift;
701	shift = T0 & 0xff;
702	if (shift >= 32) {
703	env->CF = (T1 >> 31) & 1;
704	T1 = (int32_t)T1 >> 31;
705	} else {
706	env->CF = (T1 >> (shift - 1)) & 1;
707	T1 = (int32_t)T1 >> shift;
708	}
709	FORCE_RET();
710	}
711
712	void OPPROTO op_rorl_T1_T0_cc(void)
713	{
714	int shift1, shift;
715	shift1 = T0 & 0xff;
716	shift = shift1 & 0x1f;
717	if (shift == 0) {
718	if (shift1 != 0)
719	env->CF = (T1 >> 31) & 1;
720	} else {
721	env->CF = (T1 >> (shift - 1)) & 1;
722	T1 = ((uint32_t)T1 >> shift) \| (T1 << (32 - shift));
723	}
724	FORCE_RET();
725	}
726
99c475ab FB	727	/* misc */
	728	void OPPROTO op_clz_T0(void)
	729	{
	730	int count;
	731	for (count = 32; T0 > 0; count--)
	732	T0 = T0 >> 1;
	733	T0 = count;
	734	FORCE_RET();
	735	}
	736
	737	void OPPROTO op_sarl_T0_im(void)
	738	{
	739	T0 = (int32_t)T0 >> PARAM1;
	740	}
	741
	742	/* 16->32 Sign extend */
	743	void OPPROTO op_sxl_T0(void)
	744	{
	745	T0 = (int16_t)T0;
	746	}
	747
	748	void OPPROTO op_sxl_T1(void)
	749	{
	750	T1 = (int16_t)T1;
	751	}
	752
	753	#define SIGNBIT (uint32_t)0x80000000
	754	/* saturating arithmetic */
	755	void OPPROTO op_addl_T0_T1_setq(void)
	756	{
	757	uint32_t res;
	758
	759	res = T0 + T1;
	760	if (((res ^ T0) & SIGNBIT) && !((T0 ^ T1) & SIGNBIT))
	761	env->QF = 1;
	762
	763	T0 = res;
	764	FORCE_RET();
	765	}
	766
	767	void OPPROTO op_addl_T0_T1_saturate(void)
	768	{
	769	uint32_t res;
	770
	771	res = T0 + T1;
	772	if (((res ^ T0) & SIGNBIT) && !((T0 ^ T1) & SIGNBIT)) {
	773	env->QF = 1;
	774	if (T0 & SIGNBIT)
	775	T0 = 0x80000000;
	776	else
	777	T0 = 0x7fffffff;
	778	}
	779	else
	780	T0 = res;
	781
	782	FORCE_RET();
	783	}
	784
	785	void OPPROTO op_subl_T0_T1_saturate(void)
	786	{
	787	uint32_t res;
	788
	789	res = T0 - T1;
	790	if (((res ^ T0) & SIGNBIT) && ((T0 ^ T1) & SIGNBIT)) {
791	env->QF = 1;
792	if (T0 & SIGNBIT)
793	T0 = 0x8000000;
794	else
795	T0 = 0x7fffffff;
796	}
797	else
798	T0 = res;
799
800	FORCE_RET();
801	}
802
803	/* thumb shift by immediate */
804	void OPPROTO op_shll_T0_im_thumb(void)
805	{
806	int shift;
807	shift = PARAM1;
808	if (shift != 0) {
809	env->CF = (T1 >> (32 - shift)) & 1;
810	T0 = T0 << shift;
811	}
812	env->NZF = T0;
813	FORCE_RET();
814	}
815
816	void OPPROTO op_shrl_T0_im_thumb(void)
817	{
818	int shift;
819
820	shift = PARAM1;
821	if (shift == 0) {
822	env->CF = 0;
823	T0 = 0;
824	} else {
825	env->CF = (T0 >> (shift - 1)) & 1;
826	T0 = T0 >> shift;
827	}
828	FORCE_RET();
829	}
830
831	void OPPROTO op_sarl_T0_im_thumb(void)
832	{
833	int shift;
834
835	shift = PARAM1;
836	if (shift == 0) {
837	T0 = ((int32_t)T0) >> 31;
838	env->CF = T0 & 1;
839	} else {
840	env->CF = (T0 >> (shift - 1)) & 1;
841	T0 = ((int32_t)T0) >> shift;
842	}
843	env->NZF = T0;
844	FORCE_RET();
845	}
846
2c0262af FB	847	/* exceptions */
	848
	849	void OPPROTO op_swi(void)
	850	{
	851	env->exception_index = EXCP_SWI;
	852	cpu_loop_exit();
	853	}
	854
	855	void OPPROTO op_undef_insn(void)
	856	{
	857	env->exception_index = EXCP_UDEF;
	858	cpu_loop_exit();
	859	}
	860
b7bcbe95 FB	861	/* VFP support. We follow the convention used for VFP instrunctions:
	862	Single precition routines have a "s" suffix, double precision a
	863	"d" suffix. */
2c0262af	864
b7bcbe95	865	#define VFP_OP(name, p) void OPPROTO op_vfp_##name##p(void)
2c0262af	866
b7bcbe95 FB	867	#define VFP_BINOP(name, op) \
	868	VFP_OP(name, s) \
	869	{ \
	870	FT0s = FT0s op FT1s; \
	871	} \
	872	VFP_OP(name, d) \
	873	{ \
	874	FT0d = FT0d op FT1d; \
	875	}
	876	VFP_BINOP(add, +)
	877	VFP_BINOP(sub, -)
	878	VFP_BINOP(mul, *)
	879	VFP_BINOP(div, /)
	880	#undef VFP_BINOP
	881
	882	#define VFP_HELPER(name) \
	883	VFP_OP(name, s) \
	884	{ \
	885	do_vfp_##name##s(); \
	886	} \
	887	VFP_OP(name, d) \
	888	{ \
	889	do_vfp_##name##d(); \
	890	}
	891	VFP_HELPER(abs)
	892	VFP_HELPER(sqrt)
	893	VFP_HELPER(cmp)
	894	VFP_HELPER(cmpe)
	895	#undef VFP_HELPER
	896
	897	/* XXX: Will this do the right thing for NANs. Should invert the signbit
	898	without looking at the rest of the value. */
	899	VFP_OP(neg, s)
	900	{
	901	FT0s = -FT0s;
	902	}
	903
	904	VFP_OP(neg, d)
	905	{
	906	FT0d = -FT0d;
	907	}
	908
	909	VFP_OP(F1_ld0, s)
	910	{
	911	FT1s = 0.0f;
	912	}
	913
	914	VFP_OP(F1_ld0, d)
	915	{
	916	FT1d = 0.0;
	917	}
	918
	919	/* Helper routines to perform bitwise copies between float and int. */
	920	static inline float vfp_itos(uint32_t i)
	921	{
	922	union {
	923	uint32_t i;
	924	float s;
	925	} v;
	926
	927	v.i = i;
	928	return v.s;
	929	}
	930
931	static inline uint32_t vfp_stoi(float s)
932	{
933	union {
934	uint32_t i;
935	float s;
936	} v;
937
938	v.s = s;
939	return v.i;
940	}
941
942	/* Integer to float conversion. */
943	VFP_OP(uito, s)
944	{
945	FT0s = (float)(uint32_t)vfp_stoi(FT0s);
946	}
947
948	VFP_OP(uito, d)
949	{
950	FT0d = (double)(uint32_t)vfp_stoi(FT0s);
951	}
952
953	VFP_OP(sito, s)
954	{
955	FT0s = (float)(int32_t)vfp_stoi(FT0s);
956	}
957
958	VFP_OP(sito, d)
959	{
960	FT0d = (double)(int32_t)vfp_stoi(FT0s);
961	}
962
963	/* Float to integer conversion. */
964	VFP_OP(toui, s)
965	{
966	FT0s = vfp_itos((uint32_t)FT0s);
967	}
968
969	VFP_OP(toui, d)
970	{
971	FT0s = vfp_itos((uint32_t)FT0d);
972	}
973
974	VFP_OP(tosi, s)
975	{
976	FT0s = vfp_itos((int32_t)FT0s);
977	}
978
979	VFP_OP(tosi, d)
980	{
981	FT0s = vfp_itos((int32_t)FT0d);
982	}
983
984	/* TODO: Set rounding mode properly. */
985	VFP_OP(touiz, s)
986	{
987	FT0s = vfp_itos((uint32_t)FT0s);
988	}
989
990	VFP_OP(touiz, d)
991	{
992	FT0s = vfp_itos((uint32_t)FT0d);
993	}
994
995	VFP_OP(tosiz, s)
996	{
997	FT0s = vfp_itos((int32_t)FT0s);
998	}
999
1000	VFP_OP(tosiz, d)
2c0262af	1001	{
b7bcbe95	1002	FT0s = vfp_itos((int32_t)FT0d);
2c0262af FB	1003	}
2c0262af FB	1004
b7bcbe95 FB	1005	/* floating point conversion */
b7bcbe95 FB	1006	VFP_OP(fcvtd, s)
2c0262af	1007	{
b7bcbe95	1008	FT0d = (double)FT0s;
2c0262af FB	1009	}
2c0262af FB	1010
b7bcbe95 FB	1011	VFP_OP(fcvts, d)
	1012	{
	1013	FT0s = (float)FT0d;
	1014	}
	1015
	1016	/* Get and Put values from registers. */
	1017	VFP_OP(getreg_F0, d)
	1018	{
	1019	FT0d = (double )((char *) env + PARAM1);
	1020	}
	1021
	1022	VFP_OP(getreg_F0, s)
	1023	{
	1024	FT0s = (float )((char *) env + PARAM1);
	1025	}
	1026
	1027	VFP_OP(getreg_F1, d)
	1028	{
	1029	FT1d = (double )((char *) env + PARAM1);
	1030	}
	1031
	1032	VFP_OP(getreg_F1, s)
	1033	{
	1034	FT1s = (float )((char *) env + PARAM1);
	1035	}
	1036
	1037	VFP_OP(setreg_F0, d)
	1038	{
	1039	(double )((char *) env + PARAM1) = FT0d;
	1040	}
	1041
	1042	VFP_OP(setreg_F0, s)
	1043	{
	1044	(float )((char *) env + PARAM1) = FT0s;
	1045	}
	1046
	1047	VFP_OP(foobar, d)
	1048	{
	1049	FT0d = env->vfp.regs.s[3];
	1050	}
	1051
	1052	void OPPROTO op_vfp_movl_T0_fpscr(void)
	1053	{
	1054	do_vfp_get_fpscr ();
	1055	}
	1056
	1057	void OPPROTO op_vfp_movl_T0_fpscr_flags(void)
	1058	{
	1059	T0 = env->vfp.fpscr & (0xf << 28);
	1060	}
	1061
	1062	void OPPROTO op_vfp_movl_fpscr_T0(void)
	1063	{
	1064	do_vfp_set_fpscr();
	1065	}
	1066
	1067	/* Move between FT0s to T0 */
	1068	void OPPROTO op_vfp_mrs(void)
	1069	{
	1070	T0 = vfp_stoi(FT0s);
	1071	}
	1072
	1073	void OPPROTO op_vfp_msr(void)
	1074	{
1075	FT0s = vfp_itos(T0);
1076	}
1077
1078	/* Move between FT0d and {T0,T1} */
1079	void OPPROTO op_vfp_mrrd(void)
1080	{
1081	CPU_DoubleU u;
1082
1083	u.d = FT0d;
1084	T0 = u.l.lower;
1085	T1 = u.l.upper;
1086	}
1087
1088	void OPPROTO op_vfp_mdrr(void)
1089	{
1090	CPU_DoubleU u;
1091
1092	u.l.lower = T0;
1093	u.l.upper = T1;
1094	FT0d = u.d;
1095	}
1096
1097	/* Floating point load/store. Address is in T1 */
1098	void OPPROTO op_vfp_lds(void)
1099	{
1100	FT0s = ldfl((void *)T1);
1101	}
1102
1103	void OPPROTO op_vfp_ldd(void)
1104	{
1105	FT0d = ldfq((void *)T1);
1106	}
1107
1108	void OPPROTO op_vfp_sts(void)
1109	{
1110	stfl((void *)T1, FT0s);
1111	}
1112
1113	void OPPROTO op_vfp_std(void)
1114	{
1115	stfq((void *)T1, FT0d);
1116	}