Archipelago » qemu

/*

 *  CRIS emulation for qemu: main translation routines.

 *

 *  Copyright (c) 2008 AXIS Communications AB

 *  Written by Edgar E. Iglesias.

 *

 * 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

 */

/*

 * FIXME:

 * The condition code translation is in desperate need of attention. It's slow

 * and for system simulation it seems buggy. It sucks.

 */

#include <stdarg.h>

#include <stdlib.h>

#include <stdio.h>

#include <string.h>

#include <inttypes.h>

#include <assert.h>

#include "cpu.h"

#include "exec-all.h"

#include "disas.h"

#include "tcg-op.h"

#include "helper.h"

#include "crisv32-decode.h"

#include "qemu-common.h"

#define CRIS_STATS 0

#if CRIS_STATS

#define STATS(x) x

#else

#define STATS(x)

#endif

#define DISAS_CRIS 0

#if DISAS_CRIS

#define DIS(x) x

#else

#define DIS(x)

#endif

#define D(x)

#define BUG() (gen_BUG(dc, __FILE__, __LINE__))

#define BUG_ON(x) ({if (x) BUG();})

#define DISAS_SWI 5

/* Used by the decoder.  */

#define EXTRACT_FIELD(src, start, end) \

            (((src) >> start) & ((1 << (end - start + 1)) - 1))

#define CC_MASK_NZ 0xc

#define CC_MASK_NZV 0xe

#define CC_MASK_NZVC 0xf

#define CC_MASK_RNZV 0x10e

TCGv cpu_env;

TCGv cpu_T[2];

TCGv cpu_R[16];

TCGv cpu_PR[16];

TCGv cc_src;

TCGv cc_dest;

TCGv cc_result;

TCGv cc_op;

TCGv cc_size;

TCGv cc_mask;

TCGv env_btarget;

TCGv env_pc;

/* This is the state at translation time.  */

typedef struct DisasContext {

        CPUState *env;

        target_ulong pc, ppc;

        /* Decoder.  */

        uint32_t ir;

        uint32_t opcode;

        unsigned int op1;

        unsigned int op2;

        unsigned int zsize, zzsize;

        unsigned int mode;

        unsigned int postinc;

        int update_cc;

        int cc_op;

        int cc_size;

        uint32_t cc_mask;

        int flags_live; /* Wether or not $ccs is uptodate.  */

        int flagx_live; /* Wether or not flags_x has the x flag known at

                           translation time.  */

        int flags_x;

        int clear_x; /* Clear x after this insn?  */

        int user; /* user or kernel mode.  */

        int is_jmp;

        int dyn_jmp;

        uint32_t delayed_pc;

        int delayed_branch;

        int bcc;

        uint32_t condlabel;

        struct TranslationBlock *tb;

        int singlestep_enabled;

} DisasContext;

void cris_prepare_jmp (DisasContext *dc, uint32_t dst);

static void gen_BUG(DisasContext *dc, char *file, int line)

{

        printf ("BUG: pc=%x %s %d\n", dc->pc, file, line);

        fprintf (logfile, "BUG: pc=%x %s %d\n", dc->pc, file, line);

        cpu_dump_state (dc->env, stdout, fprintf, 0);

        fflush(NULL);

        cris_prepare_jmp (dc, 0x70000000 + line);

}

const char *regnames[] =

{

        "$r0", "$r1", "$r2", "$r3",

        "$r4", "$r5", "$r6", "$r7",

        "$r8", "$r9", "$r10", "$r11",

        "$r12", "$r13", "$sp", "$acr",

};

const char *pregnames[] =

{

        "$bz", "$vr", "$pid", "$srs",

        "$wz", "$exs", "$eda", "$mof",

        "$dz", "$ebp", "$erp", "$srp",

        "$nrp", "$ccs", "$usp", "$spc",

};

/* We need this table to handle preg-moves with implicit width.  */

int preg_sizes[] = {

        1, /* bz.  */

        1, /* vr.  */

        4, /* pid.  */

        1, /* srs.  */

        2, /* wz.  */

        4, 4, 4,

        4, 4, 4, 4,

        4, 4, 4, 4,

};

#define t_gen_mov_TN_env(tn, member) \

 _t_gen_mov_TN_env((tn), offsetof(CPUState, member))

#define t_gen_mov_env_TN(member, tn) \

 _t_gen_mov_env_TN(offsetof(CPUState, member), (tn))

static inline void t_gen_mov_TN_reg(TCGv tn, int r)

{

        if (r < 0 || r > 15)

                fprintf(stderr, "wrong register read $r%d\n", r);

        tcg_gen_mov_tl(tn, cpu_R[r]);

}

static inline void t_gen_mov_reg_TN(int r, TCGv tn)

{

        if (r < 0 || r > 15)

                fprintf(stderr, "wrong register write $r%d\n", r);

        tcg_gen_mov_tl(cpu_R[r], tn);

}

static inline void _t_gen_mov_TN_env(TCGv tn, int offset)

{

        if (offset > sizeof (CPUState))

                fprintf(stderr, "wrong load from env from off=%d\n", offset);

        tcg_gen_ld_tl(tn, cpu_env, offset);

}

static inline void _t_gen_mov_env_TN(int offset, TCGv tn)

{

        if (offset > sizeof (CPUState))

                fprintf(stderr, "wrong store to env at off=%d\n", offset);

        tcg_gen_st_tl(tn, cpu_env, offset);

}

static inline void t_gen_mov_TN_preg(TCGv tn, int r)

{

        if (r < 0 || r > 15)

                fprintf(stderr, "wrong register read $p%d\n", r);

        if (r == PR_BZ || r == PR_WZ || r == PR_DZ)

                tcg_gen_mov_tl(tn, tcg_const_tl(0));

        else if (r == PR_VR)

                tcg_gen_mov_tl(tn, tcg_const_tl(32));

        else if (r == PR_EXS) {

                printf("read from EXS!\n");

                tcg_gen_mov_tl(tn, cpu_PR[r]);

        }

        else if (r == PR_EDA) {

                printf("read from EDA!\n");

                tcg_gen_mov_tl(tn, cpu_PR[r]);

        }

        else

                tcg_gen_mov_tl(tn, cpu_PR[r]);

}

static inline void t_gen_mov_preg_TN(int r, TCGv tn)

{

        if (r < 0 || r > 15)

                fprintf(stderr, "wrong register write $p%d\n", r);

        if (r == PR_BZ || r == PR_WZ || r == PR_DZ)

                return;

        else if (r == PR_SRS)

                tcg_gen_andi_tl(cpu_PR[r], tn, 3);

        else {

                if (r == PR_PID) {

                        tcg_gen_helper_0_0(helper_tlb_flush);

                }

                tcg_gen_mov_tl(cpu_PR[r], tn);

        }

}

static inline void t_gen_raise_exception(uint32_t index)

{

        tcg_gen_helper_0_1(helper_raise_exception, tcg_const_tl(index));

}

static void t_gen_lsl(TCGv d, TCGv a, TCGv b)

{

        int l1;

        l1 = gen_new_label();

        /* Speculative shift. */

        tcg_gen_shl_tl(d, a, b);

        tcg_gen_brcond_tl(TCG_COND_LEU, b, tcg_const_tl(31), l1);

        /* Clear dst if shift operands were to large.  */

        tcg_gen_movi_tl(d, 0);

        gen_set_label(l1);

}

static void t_gen_lsr(TCGv d, TCGv a, TCGv b)

{

        int l1;

        l1 = gen_new_label();

        /* Speculative shift. */

        tcg_gen_shr_tl(d, a, b);

        tcg_gen_brcond_tl(TCG_COND_LEU, b, tcg_const_tl(31), l1);

        /* Clear dst if shift operands were to large.  */

        tcg_gen_movi_tl(d, 0);

        gen_set_label(l1);

}

static void t_gen_asr(TCGv d, TCGv a, TCGv b)

{

        int l1;

        l1 = gen_new_label();

        /* Speculative shift. */

        tcg_gen_sar_tl(d, a, b);

        tcg_gen_brcond_tl(TCG_COND_LEU, b, tcg_const_tl(31), l1);

        /* Clear dst if shift operands were to large.  */

        tcg_gen_sar_tl(d, a, tcg_const_tl(30));

        gen_set_label(l1);

}

/* 64-bit signed mul, lower result in d and upper in d2.  */

static void t_gen_muls(TCGv d, TCGv d2, TCGv a, TCGv b)

{

        TCGv t0, t1;

        t0 = tcg_temp_new(TCG_TYPE_I64);

        t1 = tcg_temp_new(TCG_TYPE_I64);

        tcg_gen_ext32s_i64(t0, a);

        tcg_gen_ext32s_i64(t1, b);

        tcg_gen_mul_i64(t0, t0, t1);

        tcg_gen_trunc_i64_i32(d, t0);

        tcg_gen_shri_i64(t0, t0, 32);

        tcg_gen_trunc_i64_i32(d2, t0);

        tcg_gen_discard_i64(t0);

        tcg_gen_discard_i64(t1);

}

/* 64-bit unsigned muls, lower result in d and upper in d2.  */

static void t_gen_mulu(TCGv d, TCGv d2, TCGv a, TCGv b)

{

        TCGv t0, t1;

        t0 = tcg_temp_new(TCG_TYPE_I64);

        t1 = tcg_temp_new(TCG_TYPE_I64);

        tcg_gen_extu_i32_i64(t0, a);

        tcg_gen_extu_i32_i64(t1, b);

        tcg_gen_mul_i64(t0, t0, t1);

        tcg_gen_trunc_i64_i32(d, t0);

        tcg_gen_shri_i64(t0, t0, 32);

        tcg_gen_trunc_i64_i32(d2, t0);

        tcg_gen_discard_i64(t0);

        tcg_gen_discard_i64(t1);

}

/* 32bit branch-free binary search for counting leading zeros.  */

static void t_gen_lz_i32(TCGv d, TCGv x)

{

        TCGv y, m, n;

        y = tcg_temp_new(TCG_TYPE_I32);

        m = tcg_temp_new(TCG_TYPE_I32);

        n = tcg_temp_new(TCG_TYPE_I32);

        /* y = -(x >> 16)  */

        tcg_gen_shri_i32(y, x, 16);

        tcg_gen_neg_i32(y, y);

        /* m = (y >> 16) & 16  */

        tcg_gen_sari_i32(m, y, 16);

        tcg_gen_andi_i32(m, m, 16);

        /* n = 16 - m  */

        tcg_gen_sub_i32(n, tcg_const_i32(16), m);

        /* x = x >> m  */

        tcg_gen_shr_i32(x, x, m);

        /* y = x - 0x100  */

        tcg_gen_subi_i32(y, x, 0x100);

        /* m = (y >> 16) & 8  */

        tcg_gen_sari_i32(m, y, 16);

        tcg_gen_andi_i32(m, m, 8);

        /* n = n + m  */

        tcg_gen_add_i32(n, n, m);

        /* x = x << m  */

        tcg_gen_shl_i32(x, x, m);

        /* y = x - 0x1000  */

        tcg_gen_subi_i32(y, x, 0x1000);

        /* m = (y >> 16) & 4  */

        tcg_gen_sari_i32(m, y, 16);

        tcg_gen_andi_i32(m, m, 4);

        /* n = n + m  */

        tcg_gen_add_i32(n, n, m);

        /* x = x << m  */

        tcg_gen_shl_i32(x, x, m);

        /* y = x - 0x4000  */

        tcg_gen_subi_i32(y, x, 0x4000);

        /* m = (y >> 16) & 2  */

        tcg_gen_sari_i32(m, y, 16);

        tcg_gen_andi_i32(m, m, 2);

        /* n = n + m  */

        tcg_gen_add_i32(n, n, m);

        /* x = x << m  */

        tcg_gen_shl_i32(x, x, m);

        /* y = x >> 14  */

        tcg_gen_shri_i32(y, x, 14);

        /* m = y & ~(y >> 1)  */

        tcg_gen_sari_i32(m, y, 1);

        tcg_gen_xori_i32(m, m, 0xffffffff);

        tcg_gen_and_i32(m, m, y);

        /* d = n + 2 - m  */

        tcg_gen_addi_i32(d, n, 2);

        tcg_gen_sub_i32(d, d, m);

        tcg_gen_discard_i32(y);

        tcg_gen_discard_i32(m);

        tcg_gen_discard_i32(n);

}

static void t_gen_btst(TCGv d, TCGv s)

{

        TCGv sbit;

        TCGv bset;

        int l1;

        /* des ref:

           The N flag is set according to the selected bit in the dest reg.

           The Z flag is set if the selected bit and all bits to the right are

           zero.

           The X flag is cleared.

           Other flags are left untouched.

           The destination reg is not affected.

        unsigned int fz, sbit, bset, mask, masked_t0;

        sbit = T1 & 31;

        bset = !!(T0 & (1 << sbit));

        mask = sbit == 31 ? -1 : (1 << (sbit + 1)) - 1;

        masked_t0 = T0 & mask;

        fz = !(masked_t0 | bset);

        // Clear the X, N and Z flags.

        T0 = env->pregs[PR_CCS] & ~(X_FLAG | N_FLAG | Z_FLAG);

        // Set the N and Z flags accordingly.

        T0 |= (bset << 3) | (fz << 2);

        */

        l1 = gen_new_label();

        sbit = tcg_temp_new(TCG_TYPE_TL);

        bset = tcg_temp_new(TCG_TYPE_TL);

        /* Compute bset and sbit.  */

        tcg_gen_andi_tl(sbit, s, 31);

        tcg_gen_shl_tl(s, tcg_const_tl(1), sbit);

        tcg_gen_and_tl(bset, d, s);

        tcg_gen_shr_tl(bset, bset, sbit);

        /* Displace to N_FLAG.  */

        tcg_gen_shli_tl(bset, bset, 3);

        tcg_gen_shl_tl(sbit, tcg_const_tl(2), sbit);

        tcg_gen_subi_tl(sbit, sbit, 1);

        tcg_gen_and_tl(sbit, d, sbit);

        tcg_gen_andi_tl(d, cpu_PR[PR_CCS], ~(X_FLAG | N_FLAG | Z_FLAG));

        /* or in the N_FLAG.  */

        tcg_gen_or_tl(d, d, bset);

        tcg_gen_brcond_tl(TCG_COND_NE, sbit, tcg_const_tl(0), l1);

        /* or in the Z_FLAG.  */

        tcg_gen_ori_tl(d, d, Z_FLAG);

        gen_set_label(l1);

        tcg_gen_discard_tl(sbit);

        tcg_gen_discard_tl(bset);

}

static void t_gen_cris_dstep(TCGv d, TCGv s)

{

        int l1;

        l1 = gen_new_label();

        /* 

         * d <<= 1

         * if (d >= s)

         *    d -= s;

         */

        tcg_gen_shli_tl(d, d, 1);

        tcg_gen_brcond_tl(TCG_COND_LTU, d, s, l1);

        tcg_gen_sub_tl(d, d, s);

        gen_set_label(l1);

}

/* Extended arithmetics on CRIS.  */

static inline void t_gen_add_flag(TCGv d, int flag)

{

        TCGv c;

        c = tcg_temp_new(TCG_TYPE_TL);

        t_gen_mov_TN_preg(c, PR_CCS);

        /* Propagate carry into d.  */

        tcg_gen_andi_tl(c, c, 1 << flag);

        if (flag)

                tcg_gen_shri_tl(c, c, flag);

        tcg_gen_add_tl(d, d, c);

        tcg_gen_discard_tl(c);

}

static inline void t_gen_addx_carry(TCGv d)

{

        TCGv x, c;

        x = tcg_temp_new(TCG_TYPE_TL);

        c = tcg_temp_new(TCG_TYPE_TL);

        t_gen_mov_TN_preg(x, PR_CCS);

        tcg_gen_mov_tl(c, x);

        /* Propagate carry into d if X is set. Branch free.  */

        tcg_gen_andi_tl(c, c, C_FLAG);

        tcg_gen_andi_tl(x, x, X_FLAG);

        tcg_gen_shri_tl(x, x, 4);

        tcg_gen_and_tl(x, x, c);

        tcg_gen_add_tl(d, d, x);        

        tcg_gen_discard_tl(x);

        tcg_gen_discard_tl(c);

}

static inline void t_gen_subx_carry(TCGv d)

{

        TCGv x, c;

        x = tcg_temp_new(TCG_TYPE_TL);

        c = tcg_temp_new(TCG_TYPE_TL);

        t_gen_mov_TN_preg(x, PR_CCS);

        tcg_gen_mov_tl(c, x);

        /* Propagate carry into d if X is set. Branch free.  */

        tcg_gen_andi_tl(c, c, C_FLAG);

        tcg_gen_andi_tl(x, x, X_FLAG);

        tcg_gen_shri_tl(x, x, 4);

        tcg_gen_and_tl(x, x, c);

        tcg_gen_sub_tl(d, d, x);

        tcg_gen_discard_tl(x);

        tcg_gen_discard_tl(c);

}

/* Swap the two bytes within each half word of the s operand.

   T0 = ((T0 << 8) & 0xff00ff00) | ((T0 >> 8) & 0x00ff00ff)  */

static inline void t_gen_swapb(TCGv d, TCGv s)

{

        TCGv t, org_s;

        t = tcg_temp_new(TCG_TYPE_TL);

        org_s = tcg_temp_new(TCG_TYPE_TL);

        /* d and s may refer to the same object.  */

        tcg_gen_mov_tl(org_s, s);

        tcg_gen_shli_tl(t, org_s, 8);

        tcg_gen_andi_tl(d, t, 0xff00ff00);

        tcg_gen_shri_tl(t, org_s, 8);

        tcg_gen_andi_tl(t, t, 0x00ff00ff);

        tcg_gen_or_tl(d, d, t);

        tcg_gen_discard_tl(t);

        tcg_gen_discard_tl(org_s);

}

/* Swap the halfwords of the s operand.  */

static inline void t_gen_swapw(TCGv d, TCGv s)

{

        TCGv t;

        /* d and s refer the same object.  */

        t = tcg_temp_new(TCG_TYPE_TL);

        tcg_gen_mov_tl(t, s);

        tcg_gen_shli_tl(d, t, 16);

        tcg_gen_shri_tl(t, t, 16);

        tcg_gen_or_tl(d, d, t);

        tcg_gen_discard_tl(t);

}

/* Reverse the within each byte.

   T0 = (((T0 << 7) & 0x80808080) |

   ((T0 << 5) & 0x40404040) |

   ((T0 << 3) & 0x20202020) |

   ((T0 << 1) & 0x10101010) |

   ((T0 >> 1) & 0x08080808) |

   ((T0 >> 3) & 0x04040404) |

   ((T0 >> 5) & 0x02020202) |

   ((T0 >> 7) & 0x01010101));

 */

static inline void t_gen_swapr(TCGv d, TCGv s)

{

        struct {

                int shift; /* LSL when positive, LSR when negative.  */

                uint32_t mask;

        } bitrev [] = {

                {7, 0x80808080},

                {5, 0x40404040},

                {3, 0x20202020},

                {1, 0x10101010},

                {-1, 0x08080808},

                {-3, 0x04040404},

                {-5, 0x02020202},

                {-7, 0x01010101}

        };

        int i;

        TCGv t, org_s;

        /* d and s refer the same object.  */

        t = tcg_temp_new(TCG_TYPE_TL);

        org_s = tcg_temp_new(TCG_TYPE_TL);

        tcg_gen_mov_tl(org_s, s);

        tcg_gen_shli_tl(t, org_s,  bitrev[0].shift);

        tcg_gen_andi_tl(d, t,  bitrev[0].mask);

        for (i = 1; i < sizeof bitrev / sizeof bitrev[0]; i++) {

                if (bitrev[i].shift >= 0) {

                        tcg_gen_shli_tl(t, org_s,  bitrev[i].shift);

                } else {

                        tcg_gen_shri_tl(t, org_s,  -bitrev[i].shift);

                }

                tcg_gen_andi_tl(t, t,  bitrev[i].mask);

                tcg_gen_or_tl(d, d, t);

        }

        tcg_gen_discard_tl(t);

        tcg_gen_discard_tl(org_s);

}

static void t_gen_cc_jmp(target_ulong pc_true, target_ulong pc_false)

{

        TCGv btaken;

        int l1;

        l1 = gen_new_label();

        btaken = tcg_temp_new(TCG_TYPE_TL);

        /* Conditional jmp.  */

        t_gen_mov_TN_env(btaken, btaken);

        tcg_gen_movi_tl(env_pc, pc_false);

        tcg_gen_brcond_tl(TCG_COND_EQ, btaken, tcg_const_tl(0), l1);

        tcg_gen_movi_tl(env_pc, pc_true);

        gen_set_label(l1);

        tcg_gen_discard_tl(btaken);

}

static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest)

{

        TranslationBlock *tb;

        tb = dc->tb;

        if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK)) {

                tcg_gen_goto_tb(n);

                tcg_gen_movi_tl(env_pc, dest);

                tcg_gen_exit_tb((long)tb + n);

        } else {

                tcg_gen_mov_tl(env_pc, cpu_T[0]);

                tcg_gen_exit_tb(0);

        }

}

/* Sign extend at translation time.  */

static int sign_extend(unsigned int val, unsigned int width)

{

        int sval;

        /* LSL.  */

        val <<= 31 - width;

        sval = val;

        /* ASR.  */

        sval >>= 31 - width;

        return sval;

}

static inline void cris_clear_x_flag(DisasContext *dc)

{

        if (!dc->flagx_live 

            || (dc->flagx_live && dc->flags_x)

            || dc->cc_op != CC_OP_FLAGS)

                tcg_gen_andi_i32(cpu_PR[PR_CCS], cpu_PR[PR_CCS], ~X_FLAG);

        dc->flagx_live = 1;

        dc->flags_x = 0;

}

static void cris_evaluate_flags(DisasContext *dc)

{

        if (!dc->flags_live) {

                tcg_gen_movi_tl(cc_op, dc->cc_op);

                tcg_gen_movi_tl(cc_size, dc->cc_size);

                tcg_gen_movi_tl(cc_mask, dc->cc_mask);

                switch (dc->cc_op)

                {

                        case CC_OP_MCP:

                                tcg_gen_helper_0_0(helper_evaluate_flags_mcp);

                                break;

                        case CC_OP_MULS:

                                tcg_gen_helper_0_0(helper_evaluate_flags_muls);

                                break;

                        case CC_OP_MULU:

                                tcg_gen_helper_0_0(helper_evaluate_flags_mulu);

                                break;

                        case CC_OP_MOVE:

                                switch (dc->cc_size)

                                {

                                        case 4:

                                                tcg_gen_helper_0_0(helper_evaluate_flags_move_4);

                                                break;

                                        case 2:

                                                tcg_gen_helper_0_0(helper_evaluate_flags_move_2);

                                                break;

                                        default:

                                                tcg_gen_helper_0_0(helper_evaluate_flags);

                                                break;

                                }

                                break;

                        case CC_OP_FLAGS:

                                /* live.  */

                                break;

                        default:

                        {

                                switch (dc->cc_size)

                                {

                                        case 4:

                                                tcg_gen_helper_0_0(helper_evaluate_flags_alu_4);

                                                break;

                                        default:

                                                tcg_gen_helper_0_0(helper_evaluate_flags);

                                                break;

                                }

                        }

                        break;

                }

                dc->flags_live = 1;

        }

}

static void cris_cc_mask(DisasContext *dc, unsigned int mask)

{

        uint32_t ovl;

        /* Check if we need to evaluate the condition codes due to 

           CC overlaying.  */

        ovl = (dc->cc_mask ^ mask) & ~mask;

        if (ovl) {

                /* TODO: optimize this case. It trigs all the time.  */

                cris_evaluate_flags (dc);

        }

        dc->cc_mask = mask;

        dc->update_cc = 1;

        if (mask == 0)

                dc->update_cc = 0;

        else

                dc->flags_live = 0;

}

static void cris_update_cc_op(DisasContext *dc, int op, int size)

{

        dc->cc_op = op;

        dc->cc_size = size;

        dc->flags_live = 0;

}

/* op is the operation.

   T0, T1 are the operands.

   dst is the destination reg.

*/

static void crisv32_alu_op(DisasContext *dc, int op, int rd, int size)

{

        int writeback = 1;

        if (dc->update_cc) {

                cris_update_cc_op(dc, op, size);

                tcg_gen_mov_tl(cc_dest, cpu_T[0]);

                /* FIXME: This shouldn't be needed. But we don't pass the

                 tests without it. Investigate.  */

                t_gen_mov_env_TN(cc_x_live, tcg_const_tl(dc->flagx_live));

                t_gen_mov_env_TN(cc_x, tcg_const_tl(dc->flags_x));

        }

        /* Emit the ALU insns.  */

        switch (op)

        {

                case CC_OP_ADD:

                        tcg_gen_add_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        /* Extended arithmetics.  */

                        t_gen_addx_carry(cpu_T[0]);

                        break;

                case CC_OP_ADDC:

                        tcg_gen_add_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        t_gen_add_flag(cpu_T[0], 0); /* C_FLAG.  */

                        break;

                case CC_OP_MCP:

                        tcg_gen_add_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        t_gen_add_flag(cpu_T[0], 8); /* R_FLAG.  */

                        break;

                case CC_OP_SUB:

                        tcg_gen_neg_tl(cpu_T[1], cpu_T[1]);

                        tcg_gen_add_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        tcg_gen_neg_tl(cpu_T[1], cpu_T[1]);

                        /* CRIS flag evaluation needs ~src.  */

                        tcg_gen_xori_tl(cpu_T[1], cpu_T[1], -1);

                        /* Extended arithmetics.  */

                        t_gen_subx_carry(cpu_T[0]);

                        break;

                case CC_OP_MOVE:

                        tcg_gen_mov_tl(cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_OR:

                        tcg_gen_or_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_AND:

                        tcg_gen_and_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_XOR:

                        tcg_gen_xor_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_LSL:

                        t_gen_lsl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_LSR:

                        t_gen_lsr(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_ASR:

                        t_gen_asr(cpu_T[0], cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_NEG:

                        tcg_gen_neg_tl(cpu_T[0], cpu_T[1]);

                        /* Extended arithmetics.  */

                        t_gen_subx_carry(cpu_T[0]);

                        break;

                case CC_OP_LZ:

                        t_gen_lz_i32(cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_BTST:

                        t_gen_btst(cpu_T[0], cpu_T[1]);

                        writeback = 0;

                        break;

                case CC_OP_MULS:

                {

                        TCGv mof;

                        mof = tcg_temp_new(TCG_TYPE_TL);

                        t_gen_muls(cpu_T[0], mof, cpu_T[0], cpu_T[1]);

                        t_gen_mov_preg_TN(PR_MOF, mof);

                        tcg_gen_discard_tl(mof);

                }

                break;

                case CC_OP_MULU:

                {

                        TCGv mof;

                        mof = tcg_temp_new(TCG_TYPE_TL);

                        t_gen_mulu(cpu_T[0], mof, cpu_T[0], cpu_T[1]);

                        t_gen_mov_preg_TN(PR_MOF, mof);

                        tcg_gen_discard_tl(mof);

                }

                break;

                case CC_OP_DSTEP:

                        t_gen_cris_dstep(cpu_T[0], cpu_T[1]);

                        break;

                case CC_OP_BOUND:

                {

                        int l1;

                        l1 = gen_new_label();

                        tcg_gen_brcond_tl(TCG_COND_LEU, 

                                          cpu_T[0], cpu_T[1], l1);

                        tcg_gen_mov_tl(cpu_T[0], cpu_T[1]);

                        gen_set_label(l1);

                }

                break;

                case CC_OP_CMP:

                        tcg_gen_neg_tl(cpu_T[1], cpu_T[1]);

                        tcg_gen_add_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        /* CRIS flag evaluation needs ~src.  */

                        tcg_gen_neg_tl(cpu_T[1], cpu_T[1]);

                        /* CRIS flag evaluation needs ~src.  */

                        tcg_gen_xori_tl(cpu_T[1], cpu_T[1], -1);

                        /* Extended arithmetics.  */

                        t_gen_subx_carry(cpu_T[0]);

                        writeback = 0;

                        break;

                default:

                        fprintf (logfile, "illegal ALU op.\n");

                        BUG();

                        break;

        }

        if (dc->update_cc)

                tcg_gen_mov_tl(cc_src, cpu_T[1]);

        if (size == 1)

                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], 0xff);

        else if (size == 2)

                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], 0xffff);

        /* Writeback.  */

        if (writeback) {

                if (size == 4)

                        t_gen_mov_reg_TN(rd, cpu_T[0]);

                else {

                        tcg_gen_mov_tl(cpu_T[1], cpu_T[0]);

                        t_gen_mov_TN_reg(cpu_T[0], rd);

                        if (size == 1)

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], ~0xff);

                        else

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], ~0xffff);

                        tcg_gen_or_tl(cpu_T[0], cpu_T[0], cpu_T[1]);

                        t_gen_mov_reg_TN(rd, cpu_T[0]);

                        tcg_gen_mov_tl(cpu_T[0], cpu_T[1]);

                }

        }

        if (dc->update_cc)

                tcg_gen_mov_tl(cc_result, cpu_T[0]);

        {

                /* TODO: Optimize this.  */

                if (!dc->flagx_live)

                        cris_evaluate_flags(dc);

        }

}

static int arith_cc(DisasContext *dc)

{

        if (dc->update_cc) {

                switch (dc->cc_op) {

                        case CC_OP_ADD: return 1;

                        case CC_OP_SUB: return 1;

                        case CC_OP_LSL: return 1;

                        case CC_OP_LSR: return 1;

                        case CC_OP_ASR: return 1;

                        case CC_OP_CMP: return 1;

                        default:

                                return 0;

                }

        }

        return 0;

}

static void gen_tst_cc (DisasContext *dc, int cond)

{

        int arith_opt;

        /* TODO: optimize more condition codes.  */

        /*

         * If the flags are live, we've gotta look into the bits of CCS.

         * Otherwise, if we just did an arithmetic operation we try to

         * evaluate the condition code faster.

         *

         * When this function is done, T0 should be non-zero if the condition

         * code is true.

         */

        arith_opt = arith_cc(dc) && !dc->flags_live;

        switch (cond) {

                case CC_EQ:

                        if (arith_opt) {

                                /* If cc_result is zero, T0 should be 

                                   non-zero otherwise T0 should be zero.  */

                                int l1;

                                l1 = gen_new_label();

                                tcg_gen_movi_tl(cpu_T[0], 0);

                                tcg_gen_brcond_tl(TCG_COND_NE, cc_result, 

                                                  tcg_const_tl(0), l1);

                                tcg_gen_movi_tl(cpu_T[0], 1);

                                gen_set_label(l1);

                        }

                        else {

                                cris_evaluate_flags(dc);

                                tcg_gen_andi_tl(cpu_T[0], 

                                                cpu_PR[PR_CCS], Z_FLAG);

                        }

                        break;

                case CC_NE:

                        if (arith_opt)

                                tcg_gen_mov_tl(cpu_T[0], cc_result);

                        else {

                                cris_evaluate_flags(dc);

                                tcg_gen_xori_tl(cpu_T[0], cpu_PR[PR_CCS],

                                                Z_FLAG);

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], Z_FLAG);

                        }

                        break;

                case CC_CS:

                        cris_evaluate_flags(dc);

                        tcg_gen_andi_tl(cpu_T[0], cpu_PR[PR_CCS], C_FLAG);

                        break;

                case CC_CC:

                        cris_evaluate_flags(dc);

                        tcg_gen_xori_tl(cpu_T[0], cpu_PR[PR_CCS],

                                        C_FLAG);

                        tcg_gen_andi_tl(cpu_T[0], cpu_T[0], C_FLAG);

                        break;

                case CC_VS:

                        cris_evaluate_flags(dc);

                        tcg_gen_andi_tl(cpu_T[0], cpu_PR[PR_CCS], V_FLAG);

                        break;

                case CC_VC:

                        cris_evaluate_flags(dc);

                        tcg_gen_xori_tl(cpu_T[0], cpu_PR[PR_CCS],

                                        V_FLAG);

                        tcg_gen_andi_tl(cpu_T[0], cpu_T[0], V_FLAG);

                        break;

                case CC_PL:

                        if (arith_opt)

                                tcg_gen_shli_tl(cpu_T[0], cc_result, 31);

                        else {

                                cris_evaluate_flags(dc);

                                tcg_gen_xori_tl(cpu_T[0], cpu_PR[PR_CCS],

                                                N_FLAG);

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], N_FLAG);

                        }

                        break;

                case CC_MI:

                        if (arith_opt) {

                                tcg_gen_shli_tl(cpu_T[0], cc_result, 31);

                                tcg_gen_xori_tl(cpu_T[0], cpu_T[0], 1);

                        }

                        else {

                                cris_evaluate_flags(dc);

                                tcg_gen_andi_tl(cpu_T[0], cpu_PR[PR_CCS],

                                                N_FLAG);

                        }

                        break;

                case CC_LS:

                        cris_evaluate_flags(dc);

                        tcg_gen_andi_tl(cpu_T[0], cpu_PR[PR_CCS],

                                        C_FLAG | Z_FLAG);

                        break;

                case CC_HI:

                        cris_evaluate_flags(dc);

                        {

                                TCGv tmp;

                                tmp = tcg_temp_new(TCG_TYPE_TL);

                                tcg_gen_xori_tl(tmp, cpu_PR[PR_CCS],

                                                C_FLAG | Z_FLAG);

                                /* Overlay the C flag on top of the Z.  */

                                tcg_gen_shli_tl(cpu_T[0], tmp, 2);

                                tcg_gen_and_tl(cpu_T[0], tmp, cpu_T[0]);

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], Z_FLAG);

                                tcg_gen_discard_tl(tmp);

                        }

                        break;

                case CC_GE:

                        cris_evaluate_flags(dc);

                        /* Overlay the V flag on top of the N.  */

                        tcg_gen_shli_tl(cpu_T[0], cpu_PR[PR_CCS], 2);

                        tcg_gen_xor_tl(cpu_T[0],

                                       cpu_PR[PR_CCS], cpu_T[0]);

                        tcg_gen_andi_tl(cpu_T[0], cpu_T[0], N_FLAG);

                        tcg_gen_xori_tl(cpu_T[0], cpu_T[0], N_FLAG);

                        break;

                case CC_LT:

                        cris_evaluate_flags(dc);

                        /* Overlay the V flag on top of the N.  */

                        tcg_gen_shli_tl(cpu_T[0], cpu_PR[PR_CCS], 2);

                        tcg_gen_xor_tl(cpu_T[0],

                                       cpu_PR[PR_CCS], cpu_T[0]);

                        tcg_gen_andi_tl(cpu_T[0], cpu_T[0], N_FLAG);

                        break;

                case CC_GT:

                        cris_evaluate_flags(dc);

                        {

                                TCGv n, z;

                                n = tcg_temp_new(TCG_TYPE_TL);

                                z = tcg_temp_new(TCG_TYPE_TL);

                                /* To avoid a shift we overlay everything on

                                   the V flag.  */

                                tcg_gen_shri_tl(n, cpu_PR[PR_CCS], 2);

                                tcg_gen_shri_tl(z, cpu_PR[PR_CCS], 1);

                                /* invert Z.  */

                                tcg_gen_xori_tl(z, z, 2);

                                tcg_gen_xor_tl(n, n, cpu_PR[PR_CCS]);

                                tcg_gen_xori_tl(n, n, 2);

                                tcg_gen_and_tl(cpu_T[0], z, n);

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], 2);

                                tcg_gen_discard_tl(n);

                                tcg_gen_discard_tl(z);

                        }

                        break;

                case CC_LE:

                        cris_evaluate_flags(dc);

                        {

                                TCGv n, z;

                                n = tcg_temp_new(TCG_TYPE_TL);

                                z = tcg_temp_new(TCG_TYPE_TL);

                                /* To avoid a shift we overlay everything on

                                   the V flag.  */

                                tcg_gen_shri_tl(n, cpu_PR[PR_CCS], 2);

                                tcg_gen_shri_tl(z, cpu_PR[PR_CCS], 1);

                                tcg_gen_xor_tl(n, n, cpu_PR[PR_CCS]);

                                tcg_gen_or_tl(cpu_T[0], z, n);

                                tcg_gen_andi_tl(cpu_T[0], cpu_T[0], 2);

                                tcg_gen_discard_tl(n);

                                tcg_gen_discard_tl(z);

                        }

                        break;

                case CC_P:

                        cris_evaluate_flags(dc);

                        tcg_gen_andi_tl(cpu_T[0], cpu_PR[PR_CCS], P_FLAG);

                        break;

                case CC_A:

                        cris_evaluate_flags(dc);

                        tcg_gen_movi_tl(cpu_T[0], 1);

                        break;

                default:

                        BUG();

                        break;

        };

}

static void cris_prepare_cc_branch (DisasContext *dc, int offset, int cond)

{

        /* This helps us re-schedule the micro-code to insns in delay-slots

           before the actual jump.  */

        dc->delayed_branch = 2;

        dc->delayed_pc = dc->pc + offset;

        dc->bcc = cond;

        if (cond != CC_A)

        {

                gen_tst_cc (dc, cond);

                t_gen_mov_env_TN(btaken, cpu_T[0]);

        }

        tcg_gen_movi_tl(env_btarget, dc->delayed_pc);

}

/* Dynamic jumps, when the dest is in a live reg for example.  */

void cris_prepare_dyn_jmp (DisasContext *dc)

{

        /* This helps us re-schedule the micro-code to insns in delay-slots

           before the actual jump.  */

        dc->delayed_branch = 2;

        dc->dyn_jmp = 1;

        dc->bcc = CC_A;

}

void cris_prepare_jmp (DisasContext *dc, uint32_t dst)

{

        /* This helps us re-schedule the micro-code to insns in delay-slots

           before the actual jump.  */

        dc->delayed_branch = 2;

        dc->delayed_pc = dst;

        dc->dyn_jmp = 0;

        dc->bcc = CC_A;

}

void gen_load(DisasContext *dc, TCGv dst, TCGv addr, 

              unsigned int size, int sign)

{

        int mem_index = cpu_mmu_index(dc->env);

        if (size == 1) {

                if (sign)

                        tcg_gen_qemu_ld8s(dst, addr, mem_index);

                else

                        tcg_gen_qemu_ld8u(dst, addr, mem_index);

        }

        else if (size == 2) {

                if (sign)

                        tcg_gen_qemu_ld16s(dst, addr, mem_index);

                else

                        tcg_gen_qemu_ld16u(dst, addr, mem_index);

        }

        else {

                tcg_gen_qemu_ld32s(dst, addr, mem_index);

        }

}

void gen_store (DisasContext *dc, TCGv addr, TCGv val,

                unsigned int size)

{

        int mem_index = cpu_mmu_index(dc->env);

        cris_evaluate_flags(dc);

        /* Remember, operands are flipped. CRIS has reversed order.  */

        if (size == 1)

                tcg_gen_qemu_st8(val, addr, mem_index);

        else if (size == 2)

                tcg_gen_qemu_st16(val, addr, mem_index);

        else

                tcg_gen_qemu_st32(val, addr, mem_index);

}

static inline void t_gen_sext(TCGv d, TCGv s, int size)

{

        if (size == 1)

                tcg_gen_ext8s_i32(d, s);

        else if (size == 2)

                tcg_gen_ext16s_i32(d, s);

        else

                tcg_gen_mov_tl(d, s);

}

static inline void t_gen_zext(TCGv d, TCGv s, int size)

{

        if (size == 1)

                tcg_gen_ext8u_i32(d, s);

        else if (size == 2)

                tcg_gen_ext16u_i32(d, s);

        else

                tcg_gen_mov_tl(d, s);

}

#if DISAS_CRIS

static char memsize_char(int size)

{

        switch (size)

        {

                case 1: return 'b';  break;

                case 2: return 'w';  break;

                case 4: return 'd';  break;

                default:

                        return 'x';

                        break;

        }

}

#endif

static unsigned int memsize_z(DisasContext *dc)

{

        return dc->zsize + 1;

}

static unsigned int memsize_zz(DisasContext *dc)

{

        switch (dc->zzsize)

        {

                case 0: return 1;

                case 1: return 2;

                default:

                        return 4;

        }

}

static inline void do_postinc (DisasContext *dc, int size)

{

        if (dc->postinc)

                tcg_gen_addi_tl(cpu_R[dc->op1], cpu_R[dc->op1], size);

}

static void dec_prep_move_r(DisasContext *dc, int rs, int rd,

                            int size, int s_ext)

{

        if (s_ext)

                t_gen_sext(cpu_T[1], cpu_R[rs], size);

        else

                t_gen_zext(cpu_T[1], cpu_R[rs], size);

}

/* Prepare T0 and T1 for a register alu operation.

   s_ext decides if the operand1 should be sign-extended or zero-extended when

   needed.  */

static void dec_prep_alu_r(DisasContext *dc, int rs, int rd,

                          int size, int s_ext)

{

        dec_prep_move_r(dc, rs, rd, size, s_ext);

        if (s_ext)

                t_gen_sext(cpu_T[0], cpu_R[rd], size);

        else

                t_gen_zext(cpu_T[0], cpu_R[rd], size);

}

/* Prepare T0 and T1 for a memory + alu operation.

   s_ext decides if the operand1 should be sign-extended or zero-extended when

   needed.  */

static int dec_prep_alu_m(DisasContext *dc, int s_ext, int memsize)

{

        unsigned int rs, rd;

        uint32_t imm;

        int is_imm;

        int insn_len = 2;

        rs = dc->op1;

        rd = dc->op2;

        is_imm = rs == 15 && dc->postinc;

        /* Load [$rs] onto T1.  */

        if (is_imm) {

                insn_len = 2 + memsize;

                if (memsize == 1)

                        insn_len++;

                if (memsize != 4) {

                        if (s_ext) {

                                if (memsize == 1)

                                        imm = ldsb_code(dc->pc + 2);

                                else

                                        imm = ldsw_code(dc->pc + 2);

                        } else {

                                if (memsize == 1)

                                        imm = ldub_code(dc->pc + 2);

                                else

                                        imm = lduw_code(dc->pc + 2);

                        }

                } else

                        imm = ldl_code(dc->pc + 2);

                DIS(fprintf (logfile, "imm=%x rd=%d sext=%d ms=%d\n",

                            imm, rd, s_ext, memsize));

                tcg_gen_movi_tl(cpu_T[1], imm);

                dc->postinc = 0;

        } else {

                gen_load(dc, cpu_T[1], cpu_R[rs], memsize, 0);

                if (s_ext)

                        t_gen_sext(cpu_T[1], cpu_T[1], memsize);

                else

                        t_gen_zext(cpu_T[1], cpu_T[1], memsize);

        }

        /* put dest in T0.  */

        t_gen_mov_TN_reg(cpu_T[0], rd);

        return insn_len;

}

#if DISAS_CRIS

static const char *cc_name(int cc)

{

        static char *cc_names[16] = {

                "cc", "cs", "ne", "eq", "vc", "vs", "pl", "mi",

                "ls", "hi", "ge", "lt", "gt", "le", "a", "p"

        };

        assert(cc < 16);

        return cc_names[cc];

}

#endif

/* Start of insn decoders.  */

static unsigned int dec_bccq(DisasContext *dc)

{

        int32_t offset;

        int sign;

        uint32_t cond = dc->op2;

        int tmp;

        offset = EXTRACT_FIELD (dc->ir, 1, 7);

        sign = EXTRACT_FIELD(dc->ir, 0, 0);

        offset *= 2;

        offset |= sign << 8;

        tmp = offset;

        offset = sign_extend(offset, 8);

        /* op2 holds the condition-code.  */

        cris_cc_mask(dc, 0);

        cris_prepare_cc_branch (dc, offset, cond);

        return 2;

}

static unsigned int dec_addoq(DisasContext *dc)

{

        int32_t imm;