translate.c 304.5 KB
Newer Older
B
bellard 已提交
1 2
/*
 *  ARM translation
3
 *
B
bellard 已提交
4
 *  Copyright (c) 2003 Fabrice Bellard
P
pbrook 已提交
5
 *  Copyright (c) 2005-2007 CodeSourcery
6
 *  Copyright (c) 2007 OpenedHand, Ltd.
B
bellard 已提交
7 8 9 10 11 12 13 14 15 16 17 18
 *
 * 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
19
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
B
bellard 已提交
20 21 22 23 24 25 26 27 28 29
 */
#include <stdarg.h>
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <inttypes.h>

#include "cpu.h"
#include "exec-all.h"
#include "disas.h"
B
bellard 已提交
30
#include "tcg-op.h"
31
#include "qemu-log.h"
P
pbrook 已提交
32

P
pbrook 已提交
33
#include "helpers.h"
P
pbrook 已提交
34
#define GEN_HELPER 1
P
pbrook 已提交
35
#include "helpers.h"
B
bellard 已提交
36

P
pbrook 已提交
37 38 39 40 41
#define ENABLE_ARCH_5J    0
#define ENABLE_ARCH_6     arm_feature(env, ARM_FEATURE_V6)
#define ENABLE_ARCH_6K   arm_feature(env, ARM_FEATURE_V6K)
#define ENABLE_ARCH_6T2   arm_feature(env, ARM_FEATURE_THUMB2)
#define ENABLE_ARCH_7     arm_feature(env, ARM_FEATURE_V7)
B
bellard 已提交
42

P
pbrook 已提交
43
#define ARCH(x) do { if (!ENABLE_ARCH_##x) goto illegal_op; } while(0)
B
bellard 已提交
44

B
bellard 已提交
45 46
/* internal defines */
typedef struct DisasContext {
B
bellard 已提交
47
    target_ulong pc;
B
bellard 已提交
48
    int is_jmp;
49 50 51 52
    /* Nonzero if this instruction has been conditionally skipped.  */
    int condjmp;
    /* The label that will be jumped to when the instruction is skipped.  */
    int condlabel;
P
pbrook 已提交
53 54 55
    /* Thumb-2 condtional execution bits.  */
    int condexec_mask;
    int condexec_cond;
B
bellard 已提交
56
    struct TranslationBlock *tb;
B
bellard 已提交
57
    int singlestep_enabled;
B
bellard 已提交
58
    int thumb;
B
bellard 已提交
59 60 61
#if !defined(CONFIG_USER_ONLY)
    int user;
#endif
B
bellard 已提交
62 63
} DisasContext;

B
bellard 已提交
64 65 66 67 68 69
#if defined(CONFIG_USER_ONLY)
#define IS_USER(s) 1
#else
#define IS_USER(s) (s->user)
#endif

P
pbrook 已提交
70 71 72 73
/* These instructions trap after executing, so defer them until after the
   conditional executions state has been updated.  */
#define DISAS_WFI 4
#define DISAS_SWI 5
B
bellard 已提交
74

P
pbrook 已提交
75
static TCGv_ptr cpu_env;
P
pbrook 已提交
76
/* We reuse the same 64-bit temporaries for efficiency.  */
P
pbrook 已提交
77
static TCGv_i64 cpu_V0, cpu_V1, cpu_M0;
78
static TCGv_i32 cpu_R[16];
P
pbrook 已提交
79

P
pbrook 已提交
80
/* FIXME:  These should be removed.  */
P
pbrook 已提交
81 82
static TCGv cpu_F0s, cpu_F1s;
static TCGv_i64 cpu_F0d, cpu_F1d;
P
pbrook 已提交
83

P
pbrook 已提交
84 85
#include "gen-icount.h"

86 87 88 89
static const char *regnames[] =
    { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
      "r8", "r9", "r10", "r11", "r12", "r13", "r14", "pc" };

P
pbrook 已提交
90 91 92
/* initialize TCG globals.  */
void arm_translate_init(void)
{
93 94
    int i;

P
pbrook 已提交
95 96
    cpu_env = tcg_global_reg_new_ptr(TCG_AREG0, "env");

97 98 99 100 101 102
    for (i = 0; i < 16; i++) {
        cpu_R[i] = tcg_global_mem_new_i32(TCG_AREG0,
                                          offsetof(CPUState, regs[i]),
                                          regnames[i]);
    }

P
pbrook 已提交
103 104
#define GEN_HELPER 2
#include "helpers.h"
P
pbrook 已提交
105 106 107 108 109
}

static int num_temps;

/* Allocate a temporary variable.  */
P
pbrook 已提交
110
static TCGv_i32 new_tmp(void)
P
pbrook 已提交
111
{
112 113
    num_temps++;
    return tcg_temp_new_i32();
P
pbrook 已提交
114 115 116 117 118
}

/* Release a temporary variable.  */
static void dead_tmp(TCGv tmp)
{
119
    tcg_temp_free(tmp);
P
pbrook 已提交
120 121 122
    num_temps--;
}

P
pbrook 已提交
123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
static inline TCGv load_cpu_offset(int offset)
{
    TCGv tmp = new_tmp();
    tcg_gen_ld_i32(tmp, cpu_env, offset);
    return tmp;
}

#define load_cpu_field(name) load_cpu_offset(offsetof(CPUState, name))

static inline void store_cpu_offset(TCGv var, int offset)
{
    tcg_gen_st_i32(var, cpu_env, offset);
    dead_tmp(var);
}

#define store_cpu_field(var, name) \
    store_cpu_offset(var, offsetof(CPUState, name))

P
pbrook 已提交
141 142 143 144 145 146 147 148 149 150 151 152
/* Set a variable to the value of a CPU register.  */
static void load_reg_var(DisasContext *s, TCGv var, int reg)
{
    if (reg == 15) {
        uint32_t addr;
        /* normaly, since we updated PC, we need only to add one insn */
        if (s->thumb)
            addr = (long)s->pc + 2;
        else
            addr = (long)s->pc + 4;
        tcg_gen_movi_i32(var, addr);
    } else {
153
        tcg_gen_mov_i32(var, cpu_R[reg]);
P
pbrook 已提交
154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172
    }
}

/* Create a new temporary and set it to the value of a CPU register.  */
static inline TCGv load_reg(DisasContext *s, int reg)
{
    TCGv tmp = new_tmp();
    load_reg_var(s, tmp, reg);
    return tmp;
}

/* Set a CPU register.  The source must be a temporary and will be
   marked as dead.  */
static void store_reg(DisasContext *s, int reg, TCGv var)
{
    if (reg == 15) {
        tcg_gen_andi_i32(var, var, ~1);
        s->is_jmp = DISAS_JUMP;
    }
173
    tcg_gen_mov_i32(cpu_R[reg], var);
P
pbrook 已提交
174 175 176 177
    dead_tmp(var);
}

/* Value extensions.  */
P
pbrook 已提交
178 179
#define gen_uxtb(var) tcg_gen_ext8u_i32(var, var)
#define gen_uxth(var) tcg_gen_ext16u_i32(var, var)
P
pbrook 已提交
180 181 182
#define gen_sxtb(var) tcg_gen_ext8s_i32(var, var)
#define gen_sxth(var) tcg_gen_ext16s_i32(var, var)

P
pbrook 已提交
183 184
#define gen_sxtb16(var) gen_helper_sxtb16(var, var)
#define gen_uxtb16(var) gen_helper_uxtb16(var, var)
P
pbrook 已提交
185

P
pbrook 已提交
186

187 188 189 190 191 192
static inline void gen_set_cpsr(TCGv var, uint32_t mask)
{
    TCGv tmp_mask = tcg_const_i32(mask);
    gen_helper_cpsr_write(var, tmp_mask);
    tcg_temp_free_i32(tmp_mask);
}
P
pbrook 已提交
193 194 195 196 197 198 199 200 201 202 203
/* Set NZCV flags from the high 4 bits of var.  */
#define gen_set_nzcv(var) gen_set_cpsr(var, CPSR_NZCV)

static void gen_exception(int excp)
{
    TCGv tmp = new_tmp();
    tcg_gen_movi_i32(tmp, excp);
    gen_helper_exception(tmp);
    dead_tmp(tmp);
}

P
pbrook 已提交
204 205 206 207
static void gen_smul_dual(TCGv a, TCGv b)
{
    TCGv tmp1 = new_tmp();
    TCGv tmp2 = new_tmp();
208 209
    tcg_gen_ext16s_i32(tmp1, a);
    tcg_gen_ext16s_i32(tmp2, b);
P
pbrook 已提交
210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
    tcg_gen_mul_i32(tmp1, tmp1, tmp2);
    dead_tmp(tmp2);
    tcg_gen_sari_i32(a, a, 16);
    tcg_gen_sari_i32(b, b, 16);
    tcg_gen_mul_i32(b, b, a);
    tcg_gen_mov_i32(a, tmp1);
    dead_tmp(tmp1);
}

/* Byteswap each halfword.  */
static void gen_rev16(TCGv var)
{
    TCGv tmp = new_tmp();
    tcg_gen_shri_i32(tmp, var, 8);
    tcg_gen_andi_i32(tmp, tmp, 0x00ff00ff);
    tcg_gen_shli_i32(var, var, 8);
    tcg_gen_andi_i32(var, var, 0xff00ff00);
    tcg_gen_or_i32(var, var, tmp);
    dead_tmp(tmp);
}

/* Byteswap low halfword and sign extend.  */
static void gen_revsh(TCGv var)
{
    TCGv tmp = new_tmp();
    tcg_gen_shri_i32(tmp, var, 8);
    tcg_gen_andi_i32(tmp, tmp, 0x00ff);
    tcg_gen_shli_i32(var, var, 8);
    tcg_gen_ext8s_i32(var, var);
    tcg_gen_or_i32(var, var, tmp);
    dead_tmp(tmp);
}

/* Unsigned bitfield extract.  */
static void gen_ubfx(TCGv var, int shift, uint32_t mask)
{
    if (shift)
        tcg_gen_shri_i32(var, var, shift);
    tcg_gen_andi_i32(var, var, mask);
}

/* Signed bitfield extract.  */
static void gen_sbfx(TCGv var, int shift, int width)
{
    uint32_t signbit;

    if (shift)
        tcg_gen_sari_i32(var, var, shift);
    if (shift + width < 32) {
        signbit = 1u << (width - 1);
        tcg_gen_andi_i32(var, var, (1u << width) - 1);
        tcg_gen_xori_i32(var, var, signbit);
        tcg_gen_subi_i32(var, var, signbit);
    }
}

/* Bitfield insertion.  Insert val into base.  Clobbers base and val.  */
static void gen_bfi(TCGv dest, TCGv base, TCGv val, int shift, uint32_t mask)
{
    tcg_gen_andi_i32(val, val, mask);
P
pbrook 已提交
270 271
    tcg_gen_shli_i32(val, val, shift);
    tcg_gen_andi_i32(base, base, ~(mask << shift));
P
pbrook 已提交
272 273 274
    tcg_gen_or_i32(dest, base, val);
}

P
pbrook 已提交
275 276
/* Round the top 32 bits of a 64-bit value.  */
static void gen_roundqd(TCGv a, TCGv b)
P
pbrook 已提交
277
{
P
pbrook 已提交
278 279
    tcg_gen_shri_i32(a, a, 31);
    tcg_gen_add_i32(a, a, b);
P
pbrook 已提交
280 281
}

P
pbrook 已提交
282 283
/* FIXME: Most targets have native widening multiplication.
   It would be good to use that instead of a full wide multiply.  */
P
pbrook 已提交
284
/* 32x32->64 multiply.  Marks inputs as dead.  */
P
pbrook 已提交
285
static TCGv_i64 gen_mulu_i64_i32(TCGv a, TCGv b)
P
pbrook 已提交
286
{
P
pbrook 已提交
287 288
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
289 290 291 292 293 294

    tcg_gen_extu_i32_i64(tmp1, a);
    dead_tmp(a);
    tcg_gen_extu_i32_i64(tmp2, b);
    dead_tmp(b);
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
295
    tcg_temp_free_i64(tmp2);
P
pbrook 已提交
296 297 298
    return tmp1;
}

P
pbrook 已提交
299
static TCGv_i64 gen_muls_i64_i32(TCGv a, TCGv b)
P
pbrook 已提交
300
{
P
pbrook 已提交
301 302
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
303 304 305 306 307 308

    tcg_gen_ext_i32_i64(tmp1, a);
    dead_tmp(a);
    tcg_gen_ext_i32_i64(tmp2, b);
    dead_tmp(b);
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
309
    tcg_temp_free_i64(tmp2);
P
pbrook 已提交
310 311 312
    return tmp1;
}

P
pbrook 已提交
313
/* Unsigned 32x32->64 multiply.  */
314
static void gen_mull(TCGv a, TCGv b)
P
pbrook 已提交
315
{
P
pbrook 已提交
316 317
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
318

319 320
    tcg_gen_extu_i32_i64(tmp1, a);
    tcg_gen_extu_i32_i64(tmp2, b);
P
pbrook 已提交
321
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
322
    tcg_temp_free_i64(tmp2);
323
    tcg_gen_trunc_i64_i32(a, tmp1);
P
pbrook 已提交
324
    tcg_gen_shri_i64(tmp1, tmp1, 32);
325
    tcg_gen_trunc_i64_i32(b, tmp1);
326
    tcg_temp_free_i64(tmp1);
P
pbrook 已提交
327 328 329
}

/* Signed 32x32->64 multiply.  */
P
pbrook 已提交
330
static void gen_imull(TCGv a, TCGv b)
P
pbrook 已提交
331
{
P
pbrook 已提交
332 333
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
334

P
pbrook 已提交
335 336
    tcg_gen_ext_i32_i64(tmp1, a);
    tcg_gen_ext_i32_i64(tmp2, b);
P
pbrook 已提交
337
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
338
    tcg_temp_free_i64(tmp2);
P
pbrook 已提交
339
    tcg_gen_trunc_i64_i32(a, tmp1);
P
pbrook 已提交
340
    tcg_gen_shri_i64(tmp1, tmp1, 32);
P
pbrook 已提交
341
    tcg_gen_trunc_i64_i32(b, tmp1);
342
    tcg_temp_free_i64(tmp1);
P
pbrook 已提交
343 344
}

P
pbrook 已提交
345 346 347 348 349 350 351
/* Swap low and high halfwords.  */
static void gen_swap_half(TCGv var)
{
    TCGv tmp = new_tmp();
    tcg_gen_shri_i32(tmp, var, 16);
    tcg_gen_shli_i32(var, var, 16);
    tcg_gen_or_i32(var, var, tmp);
P
pbrook 已提交
352
    dead_tmp(tmp);
P
pbrook 已提交
353 354
}

P
pbrook 已提交
355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374
/* Dual 16-bit add.  Result placed in t0 and t1 is marked as dead.
    tmp = (t0 ^ t1) & 0x8000;
    t0 &= ~0x8000;
    t1 &= ~0x8000;
    t0 = (t0 + t1) ^ tmp;
 */

static void gen_add16(TCGv t0, TCGv t1)
{
    TCGv tmp = new_tmp();
    tcg_gen_xor_i32(tmp, t0, t1);
    tcg_gen_andi_i32(tmp, tmp, 0x8000);
    tcg_gen_andi_i32(t0, t0, ~0x8000);
    tcg_gen_andi_i32(t1, t1, ~0x8000);
    tcg_gen_add_i32(t0, t0, t1);
    tcg_gen_xor_i32(t0, t0, tmp);
    dead_tmp(tmp);
    dead_tmp(t1);
}

P
pbrook 已提交
375 376
#define gen_set_CF(var) tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, CF))

P
pbrook 已提交
377 378 379 380 381
/* Set CF to the top bit of var.  */
static void gen_set_CF_bit31(TCGv var)
{
    TCGv tmp = new_tmp();
    tcg_gen_shri_i32(tmp, var, 31);
382
    gen_set_CF(tmp);
P
pbrook 已提交
383 384 385 386 387 388
    dead_tmp(tmp);
}

/* Set N and Z flags from var.  */
static inline void gen_logic_CC(TCGv var)
{
P
pbrook 已提交
389 390
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, NF));
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, ZF));
P
pbrook 已提交
391 392 393
}

/* T0 += T1 + CF.  */
394
static void gen_adc(TCGv t0, TCGv t1)
P
pbrook 已提交
395
{
P
pbrook 已提交
396
    TCGv tmp;
397
    tcg_gen_add_i32(t0, t0, t1);
P
pbrook 已提交
398
    tmp = load_cpu_field(CF);
399
    tcg_gen_add_i32(t0, t0, tmp);
P
pbrook 已提交
400 401 402
    dead_tmp(tmp);
}

403 404 405 406 407 408 409 410 411 412
/* dest = T0 + T1 + CF. */
static void gen_add_carry(TCGv dest, TCGv t0, TCGv t1)
{
    TCGv tmp;
    tcg_gen_add_i32(dest, t0, t1);
    tmp = load_cpu_field(CF);
    tcg_gen_add_i32(dest, dest, tmp);
    dead_tmp(tmp);
}

P
pbrook 已提交
413 414 415
/* dest = T0 - T1 + CF - 1.  */
static void gen_sub_carry(TCGv dest, TCGv t0, TCGv t1)
{
P
pbrook 已提交
416
    TCGv tmp;
P
pbrook 已提交
417
    tcg_gen_sub_i32(dest, t0, t1);
P
pbrook 已提交
418
    tmp = load_cpu_field(CF);
P
pbrook 已提交
419 420 421 422 423
    tcg_gen_add_i32(dest, dest, tmp);
    tcg_gen_subi_i32(dest, dest, 1);
    dead_tmp(tmp);
}

P
pbrook 已提交
424 425
/* T0 &= ~T1.  Clobbers T1.  */
/* FIXME: Implement bic natively.  */
P
pbrook 已提交
426 427 428 429 430 431 432
static inline void tcg_gen_bic_i32(TCGv dest, TCGv t0, TCGv t1)
{
    TCGv tmp = new_tmp();
    tcg_gen_not_i32(tmp, t1);
    tcg_gen_and_i32(dest, t0, tmp);
    dead_tmp(tmp);
}
P
pbrook 已提交
433

P
pbrook 已提交
434 435 436
/* FIXME:  Implement this natively.  */
#define tcg_gen_abs_i32(t0, t1) gen_helper_abs(t0, t1)

P
pbrook 已提交
437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
/* FIXME:  Implement this natively.  */
static void tcg_gen_rori_i32(TCGv t0, TCGv t1, int i)
{
    TCGv tmp;

    if (i == 0)
        return;

    tmp = new_tmp();
    tcg_gen_shri_i32(tmp, t1, i);
    tcg_gen_shli_i32(t1, t1, 32 - i);
    tcg_gen_or_i32(t0, t1, tmp);
    dead_tmp(tmp);
}

P
pbrook 已提交
452
static void shifter_out_im(TCGv var, int shift)
P
pbrook 已提交
453
{
P
pbrook 已提交
454 455 456
    TCGv tmp = new_tmp();
    if (shift == 0) {
        tcg_gen_andi_i32(tmp, var, 1);
P
pbrook 已提交
457
    } else {
P
pbrook 已提交
458
        tcg_gen_shri_i32(tmp, var, shift);
459
        if (shift != 31)
P
pbrook 已提交
460 461 462 463 464
            tcg_gen_andi_i32(tmp, tmp, 1);
    }
    gen_set_CF(tmp);
    dead_tmp(tmp);
}
P
pbrook 已提交
465

P
pbrook 已提交
466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504
/* Shift by immediate.  Includes special handling for shift == 0.  */
static inline void gen_arm_shift_im(TCGv var, int shiftop, int shift, int flags)
{
    switch (shiftop) {
    case 0: /* LSL */
        if (shift != 0) {
            if (flags)
                shifter_out_im(var, 32 - shift);
            tcg_gen_shli_i32(var, var, shift);
        }
        break;
    case 1: /* LSR */
        if (shift == 0) {
            if (flags) {
                tcg_gen_shri_i32(var, var, 31);
                gen_set_CF(var);
            }
            tcg_gen_movi_i32(var, 0);
        } else {
            if (flags)
                shifter_out_im(var, shift - 1);
            tcg_gen_shri_i32(var, var, shift);
        }
        break;
    case 2: /* ASR */
        if (shift == 0)
            shift = 32;
        if (flags)
            shifter_out_im(var, shift - 1);
        if (shift == 32)
          shift = 31;
        tcg_gen_sari_i32(var, var, shift);
        break;
    case 3: /* ROR/RRX */
        if (shift != 0) {
            if (flags)
                shifter_out_im(var, shift - 1);
            tcg_gen_rori_i32(var, var, shift); break;
        } else {
P
pbrook 已提交
505
            TCGv tmp = load_cpu_field(CF);
P
pbrook 已提交
506 507 508
            if (flags)
                shifter_out_im(var, 0);
            tcg_gen_shri_i32(var, var, 1);
P
pbrook 已提交
509 510 511 512 513 514 515
            tcg_gen_shli_i32(tmp, tmp, 31);
            tcg_gen_or_i32(var, var, tmp);
            dead_tmp(tmp);
        }
    }
};

P
pbrook 已提交
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536
static inline void gen_arm_shift_reg(TCGv var, int shiftop,
                                     TCGv shift, int flags)
{
    if (flags) {
        switch (shiftop) {
        case 0: gen_helper_shl_cc(var, var, shift); break;
        case 1: gen_helper_shr_cc(var, var, shift); break;
        case 2: gen_helper_sar_cc(var, var, shift); break;
        case 3: gen_helper_ror_cc(var, var, shift); break;
        }
    } else {
        switch (shiftop) {
        case 0: gen_helper_shl(var, var, shift); break;
        case 1: gen_helper_shr(var, var, shift); break;
        case 2: gen_helper_sar(var, var, shift); break;
        case 3: gen_helper_ror(var, var, shift); break;
        }
    }
    dead_tmp(shift);
}

P
pbrook 已提交
537 538 539 540 541 542 543 544 545
#define PAS_OP(pfx) \
    switch (op2) {  \
    case 0: gen_pas_helper(glue(pfx,add16)); break; \
    case 1: gen_pas_helper(glue(pfx,addsubx)); break; \
    case 2: gen_pas_helper(glue(pfx,subaddx)); break; \
    case 3: gen_pas_helper(glue(pfx,sub16)); break; \
    case 4: gen_pas_helper(glue(pfx,add8)); break; \
    case 7: gen_pas_helper(glue(pfx,sub8)); break; \
    }
P
pbrook 已提交
546
static void gen_arm_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
P
pbrook 已提交
547
{
P
pbrook 已提交
548
    TCGv_ptr tmp;
P
pbrook 已提交
549 550 551 552

    switch (op1) {
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
    case 1:
P
pbrook 已提交
553
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
554 555
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(s)
556
        tcg_temp_free_ptr(tmp);
P
pbrook 已提交
557 558
        break;
    case 5:
P
pbrook 已提交
559
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
560 561
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(u)
562
        tcg_temp_free_ptr(tmp);
P
pbrook 已提交
563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
        break;
#undef gen_pas_helper
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b)
    case 2:
        PAS_OP(q);
        break;
    case 3:
        PAS_OP(sh);
        break;
    case 6:
        PAS_OP(uq);
        break;
    case 7:
        PAS_OP(uh);
        break;
#undef gen_pas_helper
    }
}
P
pbrook 已提交
581 582
#undef PAS_OP

P
pbrook 已提交
583 584 585 586 587 588 589 590 591 592
/* For unknown reasons Arm and Thumb-2 use arbitrarily different encodings.  */
#define PAS_OP(pfx) \
    switch (op2) {  \
    case 0: gen_pas_helper(glue(pfx,add8)); break; \
    case 1: gen_pas_helper(glue(pfx,add16)); break; \
    case 2: gen_pas_helper(glue(pfx,addsubx)); break; \
    case 4: gen_pas_helper(glue(pfx,sub8)); break; \
    case 5: gen_pas_helper(glue(pfx,sub16)); break; \
    case 6: gen_pas_helper(glue(pfx,subaddx)); break; \
    }
P
pbrook 已提交
593
static void gen_thumb2_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
P
pbrook 已提交
594
{
P
pbrook 已提交
595
    TCGv_ptr tmp;
P
pbrook 已提交
596 597 598 599

    switch (op1) {
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
    case 0:
P
pbrook 已提交
600
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
601 602
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(s)
603
        tcg_temp_free_ptr(tmp);
P
pbrook 已提交
604 605
        break;
    case 4:
P
pbrook 已提交
606
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
607 608
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(u)
609
        tcg_temp_free_ptr(tmp);
P
pbrook 已提交
610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
        break;
#undef gen_pas_helper
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b)
    case 1:
        PAS_OP(q);
        break;
    case 2:
        PAS_OP(sh);
        break;
    case 5:
        PAS_OP(uq);
        break;
    case 6:
        PAS_OP(uh);
        break;
#undef gen_pas_helper
    }
}
P
pbrook 已提交
628 629
#undef PAS_OP

P
pbrook 已提交
630 631 632 633 634 635 636 637
static void gen_test_cc(int cc, int label)
{
    TCGv tmp;
    TCGv tmp2;
    int inv;

    switch (cc) {
    case 0: /* eq: Z */
P
pbrook 已提交
638
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
639
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
P
pbrook 已提交
640 641
        break;
    case 1: /* ne: !Z */
P
pbrook 已提交
642
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
643
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
P
pbrook 已提交
644 645 646
        break;
    case 2: /* cs: C */
        tmp = load_cpu_field(CF);
P
pbrook 已提交
647
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
P
pbrook 已提交
648 649 650
        break;
    case 3: /* cc: !C */
        tmp = load_cpu_field(CF);
P
pbrook 已提交
651
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
P
pbrook 已提交
652 653
        break;
    case 4: /* mi: N */
P
pbrook 已提交
654
        tmp = load_cpu_field(NF);
P
pbrook 已提交
655
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
P
pbrook 已提交
656 657
        break;
    case 5: /* pl: !N */
P
pbrook 已提交
658
        tmp = load_cpu_field(NF);
P
pbrook 已提交
659
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
P
pbrook 已提交
660 661 662
        break;
    case 6: /* vs: V */
        tmp = load_cpu_field(VF);
P
pbrook 已提交
663
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
P
pbrook 已提交
664 665 666
        break;
    case 7: /* vc: !V */
        tmp = load_cpu_field(VF);
P
pbrook 已提交
667
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
P
pbrook 已提交
668 669 670 671
        break;
    case 8: /* hi: C && !Z */
        inv = gen_new_label();
        tmp = load_cpu_field(CF);
P
pbrook 已提交
672
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, inv);
P
pbrook 已提交
673
        dead_tmp(tmp);
P
pbrook 已提交
674
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
675
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
P
pbrook 已提交
676 677 678 679
        gen_set_label(inv);
        break;
    case 9: /* ls: !C || Z */
        tmp = load_cpu_field(CF);
P
pbrook 已提交
680
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
P
pbrook 已提交
681
        dead_tmp(tmp);
P
pbrook 已提交
682
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
683
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
P
pbrook 已提交
684 685 686
        break;
    case 10: /* ge: N == V -> N ^ V == 0 */
        tmp = load_cpu_field(VF);
P
pbrook 已提交
687
        tmp2 = load_cpu_field(NF);
P
pbrook 已提交
688 689
        tcg_gen_xor_i32(tmp, tmp, tmp2);
        dead_tmp(tmp2);
P
pbrook 已提交
690
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
P
pbrook 已提交
691 692 693
        break;
    case 11: /* lt: N != V -> N ^ V != 0 */
        tmp = load_cpu_field(VF);
P
pbrook 已提交
694
        tmp2 = load_cpu_field(NF);
P
pbrook 已提交
695 696
        tcg_gen_xor_i32(tmp, tmp, tmp2);
        dead_tmp(tmp2);
P
pbrook 已提交
697
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
P
pbrook 已提交
698 699 700
        break;
    case 12: /* gt: !Z && N == V */
        inv = gen_new_label();
P
pbrook 已提交
701
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
702
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, inv);
P
pbrook 已提交
703 704
        dead_tmp(tmp);
        tmp = load_cpu_field(VF);
P
pbrook 已提交
705
        tmp2 = load_cpu_field(NF);
P
pbrook 已提交
706 707
        tcg_gen_xor_i32(tmp, tmp, tmp2);
        dead_tmp(tmp2);
P
pbrook 已提交
708
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
P
pbrook 已提交
709 710 711
        gen_set_label(inv);
        break;
    case 13: /* le: Z || N != V */
P
pbrook 已提交
712
        tmp = load_cpu_field(ZF);
P
pbrook 已提交
713
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
P
pbrook 已提交
714 715
        dead_tmp(tmp);
        tmp = load_cpu_field(VF);
P
pbrook 已提交
716
        tmp2 = load_cpu_field(NF);
P
pbrook 已提交
717 718
        tcg_gen_xor_i32(tmp, tmp, tmp2);
        dead_tmp(tmp2);
P
pbrook 已提交
719
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
P
pbrook 已提交
720 721 722 723 724 725 726
        break;
    default:
        fprintf(stderr, "Bad condition code 0x%x\n", cc);
        abort();
    }
    dead_tmp(tmp);
}
B
bellard 已提交
727

728
static const uint8_t table_logic_cc[16] = {
B
bellard 已提交
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745
    1, /* and */
    1, /* xor */
    0, /* sub */
    0, /* rsb */
    0, /* add */
    0, /* adc */
    0, /* sbc */
    0, /* rsc */
    1, /* andl */
    1, /* xorl */
    0, /* cmp */
    0, /* cmn */
    1, /* orr */
    1, /* mov */
    1, /* bic */
    1, /* mvn */
};
746

P
pbrook 已提交
747 748
/* Set PC and Thumb state from an immediate address.  */
static inline void gen_bx_im(DisasContext *s, uint32_t addr)
B
bellard 已提交
749
{
P
pbrook 已提交
750
    TCGv tmp;
B
bellard 已提交
751

P
pbrook 已提交
752
    s->is_jmp = DISAS_UPDATE;
P
pbrook 已提交
753
    if (s->thumb != (addr & 1)) {
754
        tmp = new_tmp();
P
pbrook 已提交
755 756
        tcg_gen_movi_i32(tmp, addr & 1);
        tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUState, thumb));
757
        dead_tmp(tmp);
P
pbrook 已提交
758
    }
759
    tcg_gen_movi_i32(cpu_R[15], addr & ~1);
P
pbrook 已提交
760 761 762 763 764 765
}

/* Set PC and Thumb state from var.  var is marked as dead.  */
static inline void gen_bx(DisasContext *s, TCGv var)
{
    s->is_jmp = DISAS_UPDATE;
766 767 768
    tcg_gen_andi_i32(cpu_R[15], var, ~1);
    tcg_gen_andi_i32(var, var, 1);
    store_cpu_field(var, thumb);
P
pbrook 已提交
769 770
}

771 772 773 774 775 776 777 778 779 780 781 782 783
/* Variant of store_reg which uses branch&exchange logic when storing
   to r15 in ARM architecture v7 and above. The source must be a temporary
   and will be marked as dead. */
static inline void store_reg_bx(CPUState *env, DisasContext *s,
                                int reg, TCGv var)
{
    if (reg == 15 && ENABLE_ARCH_7) {
        gen_bx(s, var);
    } else {
        store_reg(s, reg, var);
    }
}

P
pbrook 已提交
784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828
static inline TCGv gen_ld8s(TCGv addr, int index)
{
    TCGv tmp = new_tmp();
    tcg_gen_qemu_ld8s(tmp, addr, index);
    return tmp;
}
static inline TCGv gen_ld8u(TCGv addr, int index)
{
    TCGv tmp = new_tmp();
    tcg_gen_qemu_ld8u(tmp, addr, index);
    return tmp;
}
static inline TCGv gen_ld16s(TCGv addr, int index)
{
    TCGv tmp = new_tmp();
    tcg_gen_qemu_ld16s(tmp, addr, index);
    return tmp;
}
static inline TCGv gen_ld16u(TCGv addr, int index)
{
    TCGv tmp = new_tmp();
    tcg_gen_qemu_ld16u(tmp, addr, index);
    return tmp;
}
static inline TCGv gen_ld32(TCGv addr, int index)
{
    TCGv tmp = new_tmp();
    tcg_gen_qemu_ld32u(tmp, addr, index);
    return tmp;
}
static inline void gen_st8(TCGv val, TCGv addr, int index)
{
    tcg_gen_qemu_st8(val, addr, index);
    dead_tmp(val);
}
static inline void gen_st16(TCGv val, TCGv addr, int index)
{
    tcg_gen_qemu_st16(val, addr, index);
    dead_tmp(val);
}
static inline void gen_st32(TCGv val, TCGv addr, int index)
{
    tcg_gen_qemu_st32(val, addr, index);
    dead_tmp(val);
}
B
bellard 已提交
829

P
pbrook 已提交
830 831
static inline void gen_set_pc_im(uint32_t val)
{
832
    tcg_gen_movi_i32(cpu_R[15], val);
P
pbrook 已提交
833 834
}

B
bellard 已提交
835 836 837
/* Force a TB lookup after an instruction that changes the CPU state.  */
static inline void gen_lookup_tb(DisasContext *s)
{
838
    tcg_gen_movi_i32(cpu_R[15], s->pc & ~1);
B
bellard 已提交
839 840 841
    s->is_jmp = DISAS_UPDATE;
}

P
pbrook 已提交
842 843
static inline void gen_add_data_offset(DisasContext *s, unsigned int insn,
                                       TCGv var)
B
bellard 已提交
844
{
B
bellard 已提交
845
    int val, rm, shift, shiftop;
P
pbrook 已提交
846
    TCGv offset;
B
bellard 已提交
847 848 849 850 851 852

    if (!(insn & (1 << 25))) {
        /* immediate */
        val = insn & 0xfff;
        if (!(insn & (1 << 23)))
            val = -val;
B
bellard 已提交
853
        if (val != 0)
P
pbrook 已提交
854
            tcg_gen_addi_i32(var, var, val);
B
bellard 已提交
855 856 857 858
    } else {
        /* shift/register */
        rm = (insn) & 0xf;
        shift = (insn >> 7) & 0x1f;
B
bellard 已提交
859
        shiftop = (insn >> 5) & 3;
P
pbrook 已提交
860
        offset = load_reg(s, rm);
P
pbrook 已提交
861
        gen_arm_shift_im(offset, shiftop, shift, 0);
B
bellard 已提交
862
        if (!(insn & (1 << 23)))
P
pbrook 已提交
863
            tcg_gen_sub_i32(var, var, offset);
B
bellard 已提交
864
        else
P
pbrook 已提交
865
            tcg_gen_add_i32(var, var, offset);
P
pbrook 已提交
866
        dead_tmp(offset);
B
bellard 已提交
867 868 869
    }
}

P
pbrook 已提交
870
static inline void gen_add_datah_offset(DisasContext *s, unsigned int insn,
P
pbrook 已提交
871
                                        int extra, TCGv var)
B
bellard 已提交
872 873
{
    int val, rm;
P
pbrook 已提交
874
    TCGv offset;
875

B
bellard 已提交
876 877 878 879 880
    if (insn & (1 << 22)) {
        /* immediate */
        val = (insn & 0xf) | ((insn >> 4) & 0xf0);
        if (!(insn & (1 << 23)))
            val = -val;
881
        val += extra;
B
bellard 已提交
882
        if (val != 0)
P
pbrook 已提交
883
            tcg_gen_addi_i32(var, var, val);
B
bellard 已提交
884 885
    } else {
        /* register */
P
pbrook 已提交
886
        if (extra)
P
pbrook 已提交
887
            tcg_gen_addi_i32(var, var, extra);
B
bellard 已提交
888
        rm = (insn) & 0xf;
P
pbrook 已提交
889
        offset = load_reg(s, rm);
B
bellard 已提交
890
        if (!(insn & (1 << 23)))
P
pbrook 已提交
891
            tcg_gen_sub_i32(var, var, offset);
B
bellard 已提交
892
        else
P
pbrook 已提交
893
            tcg_gen_add_i32(var, var, offset);
P
pbrook 已提交
894
        dead_tmp(offset);
B
bellard 已提交
895 896 897
    }
}

P
pbrook 已提交
898 899 900 901 902 903 904
#define VFP_OP2(name)                                                 \
static inline void gen_vfp_##name(int dp)                             \
{                                                                     \
    if (dp)                                                           \
        gen_helper_vfp_##name##d(cpu_F0d, cpu_F0d, cpu_F1d, cpu_env); \
    else                                                              \
        gen_helper_vfp_##name##s(cpu_F0s, cpu_F0s, cpu_F1s, cpu_env); \
B
bellard 已提交
905 906
}

P
pbrook 已提交
907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956
VFP_OP2(add)
VFP_OP2(sub)
VFP_OP2(mul)
VFP_OP2(div)

#undef VFP_OP2

static inline void gen_vfp_abs(int dp)
{
    if (dp)
        gen_helper_vfp_absd(cpu_F0d, cpu_F0d);
    else
        gen_helper_vfp_abss(cpu_F0s, cpu_F0s);
}

static inline void gen_vfp_neg(int dp)
{
    if (dp)
        gen_helper_vfp_negd(cpu_F0d, cpu_F0d);
    else
        gen_helper_vfp_negs(cpu_F0s, cpu_F0s);
}

static inline void gen_vfp_sqrt(int dp)
{
    if (dp)
        gen_helper_vfp_sqrtd(cpu_F0d, cpu_F0d, cpu_env);
    else
        gen_helper_vfp_sqrts(cpu_F0s, cpu_F0s, cpu_env);
}

static inline void gen_vfp_cmp(int dp)
{
    if (dp)
        gen_helper_vfp_cmpd(cpu_F0d, cpu_F1d, cpu_env);
    else
        gen_helper_vfp_cmps(cpu_F0s, cpu_F1s, cpu_env);
}

static inline void gen_vfp_cmpe(int dp)
{
    if (dp)
        gen_helper_vfp_cmped(cpu_F0d, cpu_F1d, cpu_env);
    else
        gen_helper_vfp_cmpes(cpu_F0s, cpu_F1s, cpu_env);
}

static inline void gen_vfp_F1_ld0(int dp)
{
    if (dp)
B
balrog 已提交
957
        tcg_gen_movi_i64(cpu_F1d, 0);
P
pbrook 已提交
958
    else
B
balrog 已提交
959
        tcg_gen_movi_i32(cpu_F1s, 0);
P
pbrook 已提交
960 961 962 963 964 965 966 967 968 969 970 971 972
}

static inline void gen_vfp_uito(int dp)
{
    if (dp)
        gen_helper_vfp_uitod(cpu_F0d, cpu_F0s, cpu_env);
    else
        gen_helper_vfp_uitos(cpu_F0s, cpu_F0s, cpu_env);
}

static inline void gen_vfp_sito(int dp)
{
    if (dp)
973
        gen_helper_vfp_sitod(cpu_F0d, cpu_F0s, cpu_env);
P
pbrook 已提交
974
    else
975
        gen_helper_vfp_sitos(cpu_F0s, cpu_F0s, cpu_env);
P
pbrook 已提交
976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002
}

static inline void gen_vfp_toui(int dp)
{
    if (dp)
        gen_helper_vfp_touid(cpu_F0s, cpu_F0d, cpu_env);
    else
        gen_helper_vfp_touis(cpu_F0s, cpu_F0s, cpu_env);
}

static inline void gen_vfp_touiz(int dp)
{
    if (dp)
        gen_helper_vfp_touizd(cpu_F0s, cpu_F0d, cpu_env);
    else
        gen_helper_vfp_touizs(cpu_F0s, cpu_F0s, cpu_env);
}

static inline void gen_vfp_tosi(int dp)
{
    if (dp)
        gen_helper_vfp_tosid(cpu_F0s, cpu_F0d, cpu_env);
    else
        gen_helper_vfp_tosis(cpu_F0s, cpu_F0s, cpu_env);
}

static inline void gen_vfp_tosiz(int dp)
P
pbrook 已提交
1003 1004
{
    if (dp)
P
pbrook 已提交
1005
        gen_helper_vfp_tosizd(cpu_F0s, cpu_F0d, cpu_env);
P
pbrook 已提交
1006
    else
P
pbrook 已提交
1007 1008 1009 1010 1011 1012
        gen_helper_vfp_tosizs(cpu_F0s, cpu_F0s, cpu_env);
}

#define VFP_GEN_FIX(name) \
static inline void gen_vfp_##name(int dp, int shift) \
{ \
1013
    TCGv tmp_shift = tcg_const_i32(shift); \
P
pbrook 已提交
1014
    if (dp) \
1015
        gen_helper_vfp_##name##d(cpu_F0d, cpu_F0d, tmp_shift, cpu_env);\
P
pbrook 已提交
1016
    else \
1017 1018
        gen_helper_vfp_##name##s(cpu_F0s, cpu_F0s, tmp_shift, cpu_env);\
    tcg_temp_free_i32(tmp_shift); \
P
pbrook 已提交
1019
}
P
pbrook 已提交
1020 1021 1022 1023 1024 1025 1026 1027 1028
VFP_GEN_FIX(tosh)
VFP_GEN_FIX(tosl)
VFP_GEN_FIX(touh)
VFP_GEN_FIX(toul)
VFP_GEN_FIX(shto)
VFP_GEN_FIX(slto)
VFP_GEN_FIX(uhto)
VFP_GEN_FIX(ulto)
#undef VFP_GEN_FIX
P
pbrook 已提交
1029

1030
static inline void gen_vfp_ld(DisasContext *s, int dp, TCGv addr)
B
bellard 已提交
1031 1032
{
    if (dp)
1033
        tcg_gen_qemu_ld64(cpu_F0d, addr, IS_USER(s));
B
bellard 已提交
1034
    else
1035
        tcg_gen_qemu_ld32u(cpu_F0s, addr, IS_USER(s));
B
bellard 已提交
1036 1037
}

1038
static inline void gen_vfp_st(DisasContext *s, int dp, TCGv addr)
B
bellard 已提交
1039 1040
{
    if (dp)
1041
        tcg_gen_qemu_st64(cpu_F0d, addr, IS_USER(s));
B
bellard 已提交
1042
    else
1043
        tcg_gen_qemu_st32(cpu_F0s, addr, IS_USER(s));
B
bellard 已提交
1044 1045
}

B
bellard 已提交
1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058
static inline long
vfp_reg_offset (int dp, int reg)
{
    if (dp)
        return offsetof(CPUARMState, vfp.regs[reg]);
    else if (reg & 1) {
        return offsetof(CPUARMState, vfp.regs[reg >> 1])
          + offsetof(CPU_DoubleU, l.upper);
    } else {
        return offsetof(CPUARMState, vfp.regs[reg >> 1])
          + offsetof(CPU_DoubleU, l.lower);
    }
}
P
pbrook 已提交
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069

/* Return the offset of a 32-bit piece of a NEON register.
   zero is the least significant end of the register.  */
static inline long
neon_reg_offset (int reg, int n)
{
    int sreg;
    sreg = reg * 2 + n;
    return vfp_reg_offset(0, sreg);
}

P
pbrook 已提交
1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
static TCGv neon_load_reg(int reg, int pass)
{
    TCGv tmp = new_tmp();
    tcg_gen_ld_i32(tmp, cpu_env, neon_reg_offset(reg, pass));
    return tmp;
}

static void neon_store_reg(int reg, int pass, TCGv var)
{
    tcg_gen_st_i32(var, cpu_env, neon_reg_offset(reg, pass));
    dead_tmp(var);
}

P
pbrook 已提交
1083
static inline void neon_load_reg64(TCGv_i64 var, int reg)
P
pbrook 已提交
1084 1085 1086 1087
{
    tcg_gen_ld_i64(var, cpu_env, vfp_reg_offset(1, reg));
}

P
pbrook 已提交
1088
static inline void neon_store_reg64(TCGv_i64 var, int reg)
P
pbrook 已提交
1089 1090 1091 1092
{
    tcg_gen_st_i64(var, cpu_env, vfp_reg_offset(1, reg));
}

P
pbrook 已提交
1093 1094 1095 1096 1097
#define tcg_gen_ld_f32 tcg_gen_ld_i32
#define tcg_gen_ld_f64 tcg_gen_ld_i64
#define tcg_gen_st_f32 tcg_gen_st_i32
#define tcg_gen_st_f64 tcg_gen_st_i64

B
bellard 已提交
1098 1099 1100
static inline void gen_mov_F0_vreg(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1101
        tcg_gen_ld_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1102
    else
P
pbrook 已提交
1103
        tcg_gen_ld_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1104 1105 1106 1107 1108
}

static inline void gen_mov_F1_vreg(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1109
        tcg_gen_ld_f64(cpu_F1d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1110
    else
P
pbrook 已提交
1111
        tcg_gen_ld_f32(cpu_F1s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1112 1113 1114 1115 1116
}

static inline void gen_mov_vreg_F0(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1117
        tcg_gen_st_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1118
    else
P
pbrook 已提交
1119
        tcg_gen_st_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1120 1121
}

1122 1123
#define ARM_CP_RW_BIT	(1 << 20)

P
pbrook 已提交
1124
static inline void iwmmxt_load_reg(TCGv_i64 var, int reg)
P
pbrook 已提交
1125 1126 1127 1128
{
    tcg_gen_ld_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
}

P
pbrook 已提交
1129
static inline void iwmmxt_store_reg(TCGv_i64 var, int reg)
P
pbrook 已提交
1130 1131 1132 1133
{
    tcg_gen_st_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
}

1134
static inline TCGv iwmmxt_load_creg(int reg)
P
pbrook 已提交
1135
{
1136 1137 1138
    TCGv var = new_tmp();
    tcg_gen_ld_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
    return var;
P
pbrook 已提交
1139 1140
}

1141
static inline void iwmmxt_store_creg(int reg, TCGv var)
P
pbrook 已提交
1142
{
1143
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
P
pbrook 已提交
1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281
}

static inline void gen_op_iwmmxt_movq_wRn_M0(int rn)
{
    iwmmxt_store_reg(cpu_M0, rn);
}

static inline void gen_op_iwmmxt_movq_M0_wRn(int rn)
{
    iwmmxt_load_reg(cpu_M0, rn);
}

static inline void gen_op_iwmmxt_orq_M0_wRn(int rn)
{
    iwmmxt_load_reg(cpu_V1, rn);
    tcg_gen_or_i64(cpu_M0, cpu_M0, cpu_V1);
}

static inline void gen_op_iwmmxt_andq_M0_wRn(int rn)
{
    iwmmxt_load_reg(cpu_V1, rn);
    tcg_gen_and_i64(cpu_M0, cpu_M0, cpu_V1);
}

static inline void gen_op_iwmmxt_xorq_M0_wRn(int rn)
{
    iwmmxt_load_reg(cpu_V1, rn);
    tcg_gen_xor_i64(cpu_M0, cpu_M0, cpu_V1);
}

#define IWMMXT_OP(name) \
static inline void gen_op_iwmmxt_##name##_M0_wRn(int rn) \
{ \
    iwmmxt_load_reg(cpu_V1, rn); \
    gen_helper_iwmmxt_##name(cpu_M0, cpu_M0, cpu_V1); \
}

#define IWMMXT_OP_ENV(name) \
static inline void gen_op_iwmmxt_##name##_M0_wRn(int rn) \
{ \
    iwmmxt_load_reg(cpu_V1, rn); \
    gen_helper_iwmmxt_##name(cpu_M0, cpu_env, cpu_M0, cpu_V1); \
}

#define IWMMXT_OP_ENV_SIZE(name) \
IWMMXT_OP_ENV(name##b) \
IWMMXT_OP_ENV(name##w) \
IWMMXT_OP_ENV(name##l)

#define IWMMXT_OP_ENV1(name) \
static inline void gen_op_iwmmxt_##name##_M0(void) \
{ \
    gen_helper_iwmmxt_##name(cpu_M0, cpu_env, cpu_M0); \
}

IWMMXT_OP(maddsq)
IWMMXT_OP(madduq)
IWMMXT_OP(sadb)
IWMMXT_OP(sadw)
IWMMXT_OP(mulslw)
IWMMXT_OP(mulshw)
IWMMXT_OP(mululw)
IWMMXT_OP(muluhw)
IWMMXT_OP(macsw)
IWMMXT_OP(macuw)

IWMMXT_OP_ENV_SIZE(unpackl)
IWMMXT_OP_ENV_SIZE(unpackh)

IWMMXT_OP_ENV1(unpacklub)
IWMMXT_OP_ENV1(unpackluw)
IWMMXT_OP_ENV1(unpacklul)
IWMMXT_OP_ENV1(unpackhub)
IWMMXT_OP_ENV1(unpackhuw)
IWMMXT_OP_ENV1(unpackhul)
IWMMXT_OP_ENV1(unpacklsb)
IWMMXT_OP_ENV1(unpacklsw)
IWMMXT_OP_ENV1(unpacklsl)
IWMMXT_OP_ENV1(unpackhsb)
IWMMXT_OP_ENV1(unpackhsw)
IWMMXT_OP_ENV1(unpackhsl)

IWMMXT_OP_ENV_SIZE(cmpeq)
IWMMXT_OP_ENV_SIZE(cmpgtu)
IWMMXT_OP_ENV_SIZE(cmpgts)

IWMMXT_OP_ENV_SIZE(mins)
IWMMXT_OP_ENV_SIZE(minu)
IWMMXT_OP_ENV_SIZE(maxs)
IWMMXT_OP_ENV_SIZE(maxu)

IWMMXT_OP_ENV_SIZE(subn)
IWMMXT_OP_ENV_SIZE(addn)
IWMMXT_OP_ENV_SIZE(subu)
IWMMXT_OP_ENV_SIZE(addu)
IWMMXT_OP_ENV_SIZE(subs)
IWMMXT_OP_ENV_SIZE(adds)

IWMMXT_OP_ENV(avgb0)
IWMMXT_OP_ENV(avgb1)
IWMMXT_OP_ENV(avgw0)
IWMMXT_OP_ENV(avgw1)

IWMMXT_OP(msadb)

IWMMXT_OP_ENV(packuw)
IWMMXT_OP_ENV(packul)
IWMMXT_OP_ENV(packuq)
IWMMXT_OP_ENV(packsw)
IWMMXT_OP_ENV(packsl)
IWMMXT_OP_ENV(packsq)

static void gen_op_iwmmxt_set_mup(void)
{
    TCGv tmp;
    tmp = load_cpu_field(iwmmxt.cregs[ARM_IWMMXT_wCon]);
    tcg_gen_ori_i32(tmp, tmp, 2);
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCon]);
}

static void gen_op_iwmmxt_set_cup(void)
{
    TCGv tmp;
    tmp = load_cpu_field(iwmmxt.cregs[ARM_IWMMXT_wCon]);
    tcg_gen_ori_i32(tmp, tmp, 1);
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCon]);
}

static void gen_op_iwmmxt_setpsr_nz(void)
{
    TCGv tmp = new_tmp();
    gen_helper_iwmmxt_setpsr_nz(tmp, cpu_M0);
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCASF]);
}

static inline void gen_op_iwmmxt_addl_M0_wRn(int rn)
{
    iwmmxt_load_reg(cpu_V1, rn);
P
pbrook 已提交
1282
    tcg_gen_ext32u_i64(cpu_V1, cpu_V1);
P
pbrook 已提交
1283 1284 1285
    tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
}

1286
static inline int gen_iwmmxt_address(DisasContext *s, uint32_t insn, TCGv dest)
1287 1288 1289
{
    int rd;
    uint32_t offset;
1290
    TCGv tmp;
1291 1292

    rd = (insn >> 16) & 0xf;
1293
    tmp = load_reg(s, rd);
1294 1295 1296 1297 1298

    offset = (insn & 0xff) << ((insn >> 7) & 2);
    if (insn & (1 << 24)) {
        /* Pre indexed */
        if (insn & (1 << 23))
1299
            tcg_gen_addi_i32(tmp, tmp, offset);
1300
        else
1301 1302
            tcg_gen_addi_i32(tmp, tmp, -offset);
        tcg_gen_mov_i32(dest, tmp);
1303
        if (insn & (1 << 21))
1304 1305 1306
            store_reg(s, rd, tmp);
        else
            dead_tmp(tmp);
1307 1308
    } else if (insn & (1 << 21)) {
        /* Post indexed */
1309
        tcg_gen_mov_i32(dest, tmp);
1310
        if (insn & (1 << 23))
1311
            tcg_gen_addi_i32(tmp, tmp, offset);
1312
        else
1313 1314
            tcg_gen_addi_i32(tmp, tmp, -offset);
        store_reg(s, rd, tmp);
1315 1316 1317 1318 1319
    } else if (!(insn & (1 << 23)))
        return 1;
    return 0;
}

1320
static inline int gen_iwmmxt_shift(uint32_t insn, uint32_t mask, TCGv dest)
1321 1322
{
    int rd = (insn >> 0) & 0xf;
1323
    TCGv tmp;
1324

1325 1326
    if (insn & (1 << 8)) {
        if (rd < ARM_IWMMXT_wCGR0 || rd > ARM_IWMMXT_wCGR3) {
1327
            return 1;
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338
        } else {
            tmp = iwmmxt_load_creg(rd);
        }
    } else {
        tmp = new_tmp();
        iwmmxt_load_reg(cpu_V0, rd);
        tcg_gen_trunc_i64_i32(tmp, cpu_V0);
    }
    tcg_gen_andi_i32(tmp, tmp, mask);
    tcg_gen_mov_i32(dest, tmp);
    dead_tmp(tmp);
1339 1340 1341 1342 1343 1344 1345 1346 1347
    return 0;
}

/* Disassemble an iwMMXt instruction.  Returns nonzero if an error occured
   (ie. an undefined instruction).  */
static int disas_iwmmxt_insn(CPUState *env, DisasContext *s, uint32_t insn)
{
    int rd, wrd;
    int rdhi, rdlo, rd0, rd1, i;
1348 1349
    TCGv addr;
    TCGv tmp, tmp2, tmp3;
1350 1351 1352 1353 1354 1355 1356

    if ((insn & 0x0e000e00) == 0x0c000000) {
        if ((insn & 0x0fe00ff0) == 0x0c400000) {
            wrd = insn & 0xf;
            rdlo = (insn >> 12) & 0xf;
            rdhi = (insn >> 16) & 0xf;
            if (insn & ARM_CP_RW_BIT) {			/* TMRRC */
1357 1358 1359 1360
                iwmmxt_load_reg(cpu_V0, wrd);
                tcg_gen_trunc_i64_i32(cpu_R[rdlo], cpu_V0);
                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
                tcg_gen_trunc_i64_i32(cpu_R[rdhi], cpu_V0);
1361
            } else {					/* TMCRR */
1362 1363
                tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
                iwmmxt_store_reg(cpu_V0, wrd);
1364 1365 1366 1367 1368 1369
                gen_op_iwmmxt_set_mup();
            }
            return 0;
        }

        wrd = (insn >> 12) & 0xf;
1370 1371 1372
        addr = new_tmp();
        if (gen_iwmmxt_address(s, insn, addr)) {
            dead_tmp(addr);
1373
            return 1;
1374
        }
1375 1376
        if (insn & ARM_CP_RW_BIT) {
            if ((insn >> 28) == 0xf) {			/* WLDRW wCx */
1377 1378 1379
                tmp = new_tmp();
                tcg_gen_qemu_ld32u(tmp, addr, IS_USER(s));
                iwmmxt_store_creg(wrd, tmp);
1380
            } else {
P
pbrook 已提交
1381 1382 1383
                i = 1;
                if (insn & (1 << 8)) {
                    if (insn & (1 << 22)) {		/* WLDRD */
1384
                        tcg_gen_qemu_ld64(cpu_M0, addr, IS_USER(s));
P
pbrook 已提交
1385 1386
                        i = 0;
                    } else {				/* WLDRW wRd */
1387
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
1388 1389 1390
                    }
                } else {
                    if (insn & (1 << 22)) {		/* WLDRH */
1391
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
1392
                    } else {				/* WLDRB */
1393
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
1394 1395 1396 1397 1398 1399
                    }
                }
                if (i) {
                    tcg_gen_extu_i32_i64(cpu_M0, tmp);
                    dead_tmp(tmp);
                }
1400 1401 1402 1403
                gen_op_iwmmxt_movq_wRn_M0(wrd);
            }
        } else {
            if ((insn >> 28) == 0xf) {			/* WSTRW wCx */
1404 1405
                tmp = iwmmxt_load_creg(wrd);
                gen_st32(tmp, addr, IS_USER(s));
1406 1407
            } else {
                gen_op_iwmmxt_movq_M0_wRn(wrd);
P
pbrook 已提交
1408 1409 1410 1411
                tmp = new_tmp();
                if (insn & (1 << 8)) {
                    if (insn & (1 << 22)) {		/* WSTRD */
                        dead_tmp(tmp);
1412
                        tcg_gen_qemu_st64(cpu_M0, addr, IS_USER(s));
P
pbrook 已提交
1413 1414
                    } else {				/* WSTRW wRd */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1415
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
1416 1417 1418 1419
                    }
                } else {
                    if (insn & (1 << 22)) {		/* WSTRH */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1420
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
1421 1422
                    } else {				/* WSTRB */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1423
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
1424 1425
                    }
                }
1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458
            }
        }
        return 0;
    }

    if ((insn & 0x0f000000) != 0x0e000000)
        return 1;

    switch (((insn >> 12) & 0xf00) | ((insn >> 4) & 0xff)) {
    case 0x000:						/* WOR */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 0) & 0xf;
        rd1 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        gen_op_iwmmxt_orq_M0_wRn(rd1);
        gen_op_iwmmxt_setpsr_nz();
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x011:						/* TMCR */
        if (insn & 0xf)
            return 1;
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
        switch (wrd) {
        case ARM_IWMMXT_wCID:
        case ARM_IWMMXT_wCASF:
            break;
        case ARM_IWMMXT_wCon:
            gen_op_iwmmxt_set_cup();
            /* Fall through.  */
        case ARM_IWMMXT_wCSSF:
1459 1460 1461 1462 1463
            tmp = iwmmxt_load_creg(wrd);
            tmp2 = load_reg(s, rd);
            tcg_gen_bic_i32(tmp, tmp, tmp2);
            dead_tmp(tmp2);
            iwmmxt_store_creg(wrd, tmp);
1464 1465 1466 1467 1468 1469
            break;
        case ARM_IWMMXT_wCGR0:
        case ARM_IWMMXT_wCGR1:
        case ARM_IWMMXT_wCGR2:
        case ARM_IWMMXT_wCGR3:
            gen_op_iwmmxt_set_cup();
1470 1471
            tmp = load_reg(s, rd);
            iwmmxt_store_creg(wrd, tmp);
1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492
            break;
        default:
            return 1;
        }
        break;
    case 0x100:						/* WXOR */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 0) & 0xf;
        rd1 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        gen_op_iwmmxt_xorq_M0_wRn(rd1);
        gen_op_iwmmxt_setpsr_nz();
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x111:						/* TMRC */
        if (insn & 0xf)
            return 1;
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1493 1494
        tmp = iwmmxt_load_creg(wrd);
        store_reg(s, rd, tmp);
1495 1496 1497 1498 1499 1500
        break;
    case 0x300:						/* WANDN */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 0) & 0xf;
        rd1 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
P
pbrook 已提交
1501
        tcg_gen_neg_i64(cpu_M0, cpu_M0);
1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593
        gen_op_iwmmxt_andq_M0_wRn(rd1);
        gen_op_iwmmxt_setpsr_nz();
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x200:						/* WAND */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 0) & 0xf;
        rd1 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        gen_op_iwmmxt_andq_M0_wRn(rd1);
        gen_op_iwmmxt_setpsr_nz();
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x810: case 0xa10:				/* WMADD */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 0) & 0xf;
        rd1 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        if (insn & (1 << 21))
            gen_op_iwmmxt_maddsq_M0_wRn(rd1);
        else
            gen_op_iwmmxt_madduq_M0_wRn(rd1);
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x10e: case 0x50e: case 0x90e: case 0xd0e:	/* WUNPCKIL */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            gen_op_iwmmxt_unpacklb_M0_wRn(rd1);
            break;
        case 1:
            gen_op_iwmmxt_unpacklw_M0_wRn(rd1);
            break;
        case 2:
            gen_op_iwmmxt_unpackll_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x10c: case 0x50c: case 0x90c: case 0xd0c:	/* WUNPCKIH */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            gen_op_iwmmxt_unpackhb_M0_wRn(rd1);
            break;
        case 1:
            gen_op_iwmmxt_unpackhw_M0_wRn(rd1);
            break;
        case 2:
            gen_op_iwmmxt_unpackhl_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x012: case 0x112: case 0x412: case 0x512:	/* WSAD */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        if (insn & (1 << 22))
            gen_op_iwmmxt_sadw_M0_wRn(rd1);
        else
            gen_op_iwmmxt_sadb_M0_wRn(rd1);
        if (!(insn & (1 << 20)))
            gen_op_iwmmxt_addl_M0_wRn(wrd);
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x010: case 0x110: case 0x210: case 0x310:	/* WMUL */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
P
pbrook 已提交
1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604
        if (insn & (1 << 21)) {
            if (insn & (1 << 20))
                gen_op_iwmmxt_mulshw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_mulslw_M0_wRn(rd1);
        } else {
            if (insn & (1 << 20))
                gen_op_iwmmxt_muluhw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_mululw_M0_wRn(rd1);
        }
1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x410: case 0x510: case 0x610: case 0x710:	/* WMAC */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        if (insn & (1 << 21))
            gen_op_iwmmxt_macsw_M0_wRn(rd1);
        else
            gen_op_iwmmxt_macuw_M0_wRn(rd1);
        if (!(insn & (1 << 20))) {
P
pbrook 已提交
1618 1619
            iwmmxt_load_reg(cpu_V1, wrd);
            tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x006: case 0x406: case 0x806: case 0xc06:	/* WCMPEQ */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            gen_op_iwmmxt_cmpeqb_M0_wRn(rd1);
            break;
        case 1:
            gen_op_iwmmxt_cmpeqw_M0_wRn(rd1);
            break;
        case 2:
            gen_op_iwmmxt_cmpeql_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x800: case 0x900: case 0xc00: case 0xd00:	/* WAVG2 */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
P
pbrook 已提交
1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661
        if (insn & (1 << 22)) {
            if (insn & (1 << 20))
                gen_op_iwmmxt_avgw1_M0_wRn(rd1);
            else
                gen_op_iwmmxt_avgw0_M0_wRn(rd1);
        } else {
            if (insn & (1 << 20))
                gen_op_iwmmxt_avgb1_M0_wRn(rd1);
            else
                gen_op_iwmmxt_avgb0_M0_wRn(rd1);
        }
1662 1663 1664 1665 1666 1667 1668 1669 1670
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x802: case 0x902: case 0xa02: case 0xb02:	/* WALIGNR */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1671 1672 1673 1674 1675
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCGR0 + ((insn >> 20) & 3));
        tcg_gen_andi_i32(tmp, tmp, 7);
        iwmmxt_load_reg(cpu_V1, rd1);
        gen_helper_iwmmxt_align(cpu_M0, cpu_M0, cpu_V1, tmp);
        dead_tmp(tmp);
1676 1677 1678 1679
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x601: case 0x605: case 0x609: case 0x60d:	/* TINSR */
1680 1681
        if (((insn >> 6) & 3) == 3)
            return 1;
1682 1683
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1684
        tmp = load_reg(s, rd);
1685 1686 1687
        gen_op_iwmmxt_movq_M0_wRn(wrd);
        switch ((insn >> 6) & 3) {
        case 0:
1688 1689
            tmp2 = tcg_const_i32(0xff);
            tmp3 = tcg_const_i32((insn & 7) << 3);
1690 1691
            break;
        case 1:
1692 1693
            tmp2 = tcg_const_i32(0xffff);
            tmp3 = tcg_const_i32((insn & 3) << 4);
1694 1695
            break;
        case 2:
1696 1697
            tmp2 = tcg_const_i32(0xffffffff);
            tmp3 = tcg_const_i32((insn & 1) << 5);
1698
            break;
1699 1700 1701
        default:
            TCGV_UNUSED(tmp2);
            TCGV_UNUSED(tmp3);
1702
        }
1703 1704 1705 1706
        gen_helper_iwmmxt_insr(cpu_M0, cpu_M0, tmp, tmp2, tmp3);
        tcg_temp_free(tmp3);
        tcg_temp_free(tmp2);
        dead_tmp(tmp);
1707 1708 1709 1710 1711 1712
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x107: case 0x507: case 0x907: case 0xd07:	/* TEXTRM */
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1713
        if (rd == 15 || ((insn >> 22) & 3) == 3)
1714 1715
            return 1;
        gen_op_iwmmxt_movq_M0_wRn(wrd);
1716
        tmp = new_tmp();
1717 1718
        switch ((insn >> 22) & 3) {
        case 0:
1719 1720 1721 1722 1723 1724
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 7) << 3);
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
            if (insn & 8) {
                tcg_gen_ext8s_i32(tmp, tmp);
            } else {
                tcg_gen_andi_i32(tmp, tmp, 0xff);
1725 1726 1727
            }
            break;
        case 1:
1728 1729 1730 1731 1732 1733
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 3) << 4);
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
            if (insn & 8) {
                tcg_gen_ext16s_i32(tmp, tmp);
            } else {
                tcg_gen_andi_i32(tmp, tmp, 0xffff);
1734 1735 1736
            }
            break;
        case 2:
1737 1738
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 1) << 5);
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1739 1740
            break;
        }
1741
        store_reg(s, rd, tmp);
1742 1743
        break;
    case 0x117: case 0x517: case 0x917: case 0xd17:	/* TEXTRC */
1744
        if ((insn & 0x000ff008) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1745
            return 1;
1746
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
1747 1748
        switch ((insn >> 22) & 3) {
        case 0:
1749
            tcg_gen_shri_i32(tmp, tmp, ((insn & 7) << 2) + 0);
1750 1751
            break;
        case 1:
1752
            tcg_gen_shri_i32(tmp, tmp, ((insn & 3) << 3) + 4);
1753 1754
            break;
        case 2:
1755
            tcg_gen_shri_i32(tmp, tmp, ((insn & 1) << 4) + 12);
1756 1757
            break;
        }
1758 1759 1760
        tcg_gen_shli_i32(tmp, tmp, 28);
        gen_set_nzcv(tmp);
        dead_tmp(tmp);
1761 1762
        break;
    case 0x401: case 0x405: case 0x409: case 0x40d:	/* TBCST */
1763 1764
        if (((insn >> 6) & 3) == 3)
            return 1;
1765 1766
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1767
        tmp = load_reg(s, rd);
1768 1769
        switch ((insn >> 6) & 3) {
        case 0:
1770
            gen_helper_iwmmxt_bcstb(cpu_M0, tmp);
1771 1772
            break;
        case 1:
1773
            gen_helper_iwmmxt_bcstw(cpu_M0, tmp);
1774 1775
            break;
        case 2:
1776
            gen_helper_iwmmxt_bcstl(cpu_M0, tmp);
1777 1778
            break;
        }
1779
        dead_tmp(tmp);
1780 1781 1782 1783
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x113: case 0x513: case 0x913: case 0xd13:	/* TANDC */
1784
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1785
            return 1;
1786 1787 1788
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
        tmp2 = new_tmp();
        tcg_gen_mov_i32(tmp2, tmp);
1789 1790 1791
        switch ((insn >> 22) & 3) {
        case 0:
            for (i = 0; i < 7; i ++) {
1792 1793
                tcg_gen_shli_i32(tmp2, tmp2, 4);
                tcg_gen_and_i32(tmp, tmp, tmp2);
1794 1795 1796 1797
            }
            break;
        case 1:
            for (i = 0; i < 3; i ++) {
1798 1799
                tcg_gen_shli_i32(tmp2, tmp2, 8);
                tcg_gen_and_i32(tmp, tmp, tmp2);
1800 1801 1802
            }
            break;
        case 2:
1803 1804
            tcg_gen_shli_i32(tmp2, tmp2, 16);
            tcg_gen_and_i32(tmp, tmp, tmp2);
1805 1806
            break;
        }
1807 1808 1809
        gen_set_nzcv(tmp);
        dead_tmp(tmp2);
        dead_tmp(tmp);
1810 1811 1812 1813 1814 1815 1816
        break;
    case 0x01c: case 0x41c: case 0x81c: case 0xc1c:	/* WACC */
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
P
pbrook 已提交
1817
            gen_helper_iwmmxt_addcb(cpu_M0, cpu_M0);
1818 1819
            break;
        case 1:
P
pbrook 已提交
1820
            gen_helper_iwmmxt_addcw(cpu_M0, cpu_M0);
1821 1822
            break;
        case 2:
P
pbrook 已提交
1823
            gen_helper_iwmmxt_addcl(cpu_M0, cpu_M0);
1824 1825 1826 1827 1828 1829 1830 1831
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x115: case 0x515: case 0x915: case 0xd15:	/* TORC */
1832
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1833
            return 1;
1834 1835 1836
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
        tmp2 = new_tmp();
        tcg_gen_mov_i32(tmp2, tmp);
1837 1838 1839
        switch ((insn >> 22) & 3) {
        case 0:
            for (i = 0; i < 7; i ++) {
1840 1841
                tcg_gen_shli_i32(tmp2, tmp2, 4);
                tcg_gen_or_i32(tmp, tmp, tmp2);
1842 1843 1844 1845
            }
            break;
        case 1:
            for (i = 0; i < 3; i ++) {
1846 1847
                tcg_gen_shli_i32(tmp2, tmp2, 8);
                tcg_gen_or_i32(tmp, tmp, tmp2);
1848 1849 1850
            }
            break;
        case 2:
1851 1852
            tcg_gen_shli_i32(tmp2, tmp2, 16);
            tcg_gen_or_i32(tmp, tmp, tmp2);
1853 1854
            break;
        }
1855 1856 1857
        gen_set_nzcv(tmp);
        dead_tmp(tmp2);
        dead_tmp(tmp);
1858 1859 1860 1861
        break;
    case 0x103: case 0x503: case 0x903: case 0xd03:	/* TMOVMSK */
        rd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
1862
        if ((insn & 0xf) != 0 || ((insn >> 22) & 3) == 3)
1863 1864
            return 1;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1865
        tmp = new_tmp();
1866 1867
        switch ((insn >> 22) & 3) {
        case 0:
1868
            gen_helper_iwmmxt_msbb(tmp, cpu_M0);
1869 1870
            break;
        case 1:
1871
            gen_helper_iwmmxt_msbw(tmp, cpu_M0);
1872 1873
            break;
        case 2:
1874
            gen_helper_iwmmxt_msbl(tmp, cpu_M0);
1875 1876
            break;
        }
1877
        store_reg(s, rd, tmp);
1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974
        break;
    case 0x106: case 0x306: case 0x506: case 0x706:	/* WCMPGT */
    case 0x906: case 0xb06: case 0xd06: case 0xf06:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            if (insn & (1 << 21))
                gen_op_iwmmxt_cmpgtsb_M0_wRn(rd1);
            else
                gen_op_iwmmxt_cmpgtub_M0_wRn(rd1);
            break;
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_cmpgtsw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_cmpgtuw_M0_wRn(rd1);
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_cmpgtsl_M0_wRn(rd1);
            else
                gen_op_iwmmxt_cmpgtul_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x00e: case 0x20e: case 0x40e: case 0x60e:	/* WUNPCKEL */
    case 0x80e: case 0xa0e: case 0xc0e: case 0xe0e:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpacklsb_M0();
            else
                gen_op_iwmmxt_unpacklub_M0();
            break;
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpacklsw_M0();
            else
                gen_op_iwmmxt_unpackluw_M0();
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpacklsl_M0();
            else
                gen_op_iwmmxt_unpacklul_M0();
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x00c: case 0x20c: case 0x40c: case 0x60c:	/* WUNPCKEH */
    case 0x80c: case 0xa0c: case 0xc0c: case 0xe0c:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpackhsb_M0();
            else
                gen_op_iwmmxt_unpackhub_M0();
            break;
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpackhsw_M0();
            else
                gen_op_iwmmxt_unpackhuw_M0();
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_unpackhsl_M0();
            else
                gen_op_iwmmxt_unpackhul_M0();
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x204: case 0x604: case 0xa04: case 0xe04:	/* WSRL */
    case 0x214: case 0x614: case 0xa14: case 0xe14:
1975 1976
        if (((insn >> 22) & 3) == 0)
            return 1;
1977 1978 1979
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1980 1981 1982
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
1983
            return 1;
1984
        }
1985 1986
        switch ((insn >> 22) & 3) {
        case 1:
1987
            gen_helper_iwmmxt_srlw(cpu_M0, cpu_env, cpu_M0, tmp);
1988 1989
            break;
        case 2:
1990
            gen_helper_iwmmxt_srll(cpu_M0, cpu_env, cpu_M0, tmp);
1991 1992
            break;
        case 3:
1993
            gen_helper_iwmmxt_srlq(cpu_M0, cpu_env, cpu_M0, tmp);
1994 1995
            break;
        }
1996
        dead_tmp(tmp);
1997 1998 1999 2000 2001 2002
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x004: case 0x404: case 0x804: case 0xc04:	/* WSRA */
    case 0x014: case 0x414: case 0x814: case 0xc14:
2003 2004
        if (((insn >> 22) & 3) == 0)
            return 1;
2005 2006 2007
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2008 2009 2010
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
2011
            return 1;
2012
        }
2013 2014
        switch ((insn >> 22) & 3) {
        case 1:
2015
            gen_helper_iwmmxt_sraw(cpu_M0, cpu_env, cpu_M0, tmp);
2016 2017
            break;
        case 2:
2018
            gen_helper_iwmmxt_sral(cpu_M0, cpu_env, cpu_M0, tmp);
2019 2020
            break;
        case 3:
2021
            gen_helper_iwmmxt_sraq(cpu_M0, cpu_env, cpu_M0, tmp);
2022 2023
            break;
        }
2024
        dead_tmp(tmp);
2025 2026 2027 2028 2029 2030
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x104: case 0x504: case 0x904: case 0xd04:	/* WSLL */
    case 0x114: case 0x514: case 0x914: case 0xd14:
2031 2032
        if (((insn >> 22) & 3) == 0)
            return 1;
2033 2034 2035
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2036 2037 2038
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
2039
            return 1;
2040
        }
2041 2042
        switch ((insn >> 22) & 3) {
        case 1:
2043
            gen_helper_iwmmxt_sllw(cpu_M0, cpu_env, cpu_M0, tmp);
2044 2045
            break;
        case 2:
2046
            gen_helper_iwmmxt_slll(cpu_M0, cpu_env, cpu_M0, tmp);
2047 2048
            break;
        case 3:
2049
            gen_helper_iwmmxt_sllq(cpu_M0, cpu_env, cpu_M0, tmp);
2050 2051
            break;
        }
2052
        dead_tmp(tmp);
2053 2054 2055 2056 2057 2058
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x304: case 0x704: case 0xb04: case 0xf04:	/* WROR */
    case 0x314: case 0x714: case 0xb14: case 0xf14:
2059 2060
        if (((insn >> 22) & 3) == 0)
            return 1;
2061 2062 2063
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2064
        tmp = new_tmp();
2065 2066
        switch ((insn >> 22) & 3) {
        case 1:
2067 2068
            if (gen_iwmmxt_shift(insn, 0xf, tmp)) {
                dead_tmp(tmp);
2069
                return 1;
2070 2071
            }
            gen_helper_iwmmxt_rorw(cpu_M0, cpu_env, cpu_M0, tmp);
2072 2073
            break;
        case 2:
2074 2075
            if (gen_iwmmxt_shift(insn, 0x1f, tmp)) {
                dead_tmp(tmp);
2076
                return 1;
2077 2078
            }
            gen_helper_iwmmxt_rorl(cpu_M0, cpu_env, cpu_M0, tmp);
2079 2080
            break;
        case 3:
2081 2082
            if (gen_iwmmxt_shift(insn, 0x3f, tmp)) {
                dead_tmp(tmp);
2083
                return 1;
2084 2085
            }
            gen_helper_iwmmxt_rorq(cpu_M0, cpu_env, cpu_M0, tmp);
2086 2087
            break;
        }
2088
        dead_tmp(tmp);
2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x116: case 0x316: case 0x516: case 0x716:	/* WMIN */
    case 0x916: case 0xb16: case 0xd16: case 0xf16:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            if (insn & (1 << 21))
                gen_op_iwmmxt_minsb_M0_wRn(rd1);
            else
                gen_op_iwmmxt_minub_M0_wRn(rd1);
            break;
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_minsw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_minuw_M0_wRn(rd1);
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_minsl_M0_wRn(rd1);
            else
                gen_op_iwmmxt_minul_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x016: case 0x216: case 0x416: case 0x616:	/* WMAX */
    case 0x816: case 0xa16: case 0xc16: case 0xe16:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 0:
            if (insn & (1 << 21))
                gen_op_iwmmxt_maxsb_M0_wRn(rd1);
            else
                gen_op_iwmmxt_maxub_M0_wRn(rd1);
            break;
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_maxsw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_maxuw_M0_wRn(rd1);
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_maxsl_M0_wRn(rd1);
            else
                gen_op_iwmmxt_maxul_M0_wRn(rd1);
            break;
        case 3:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x002: case 0x102: case 0x202: case 0x302:	/* WALIGNI */
    case 0x402: case 0x502: case 0x602: case 0x702:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2161 2162 2163 2164
        tmp = tcg_const_i32((insn >> 20) & 3);
        iwmmxt_load_reg(cpu_V1, rd1);
        gen_helper_iwmmxt_align(cpu_M0, cpu_M0, cpu_V1, tmp);
        tcg_temp_free(tmp);
2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x01a: case 0x11a: case 0x21a: case 0x31a:	/* WSUB */
    case 0x41a: case 0x51a: case 0x61a: case 0x71a:
    case 0x81a: case 0x91a: case 0xa1a: case 0xb1a:
    case 0xc1a: case 0xd1a: case 0xe1a: case 0xf1a:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 20) & 0xf) {
        case 0x0:
            gen_op_iwmmxt_subnb_M0_wRn(rd1);
            break;
        case 0x1:
            gen_op_iwmmxt_subub_M0_wRn(rd1);
            break;
        case 0x3:
            gen_op_iwmmxt_subsb_M0_wRn(rd1);
            break;
        case 0x4:
            gen_op_iwmmxt_subnw_M0_wRn(rd1);
            break;
        case 0x5:
            gen_op_iwmmxt_subuw_M0_wRn(rd1);
            break;
        case 0x7:
            gen_op_iwmmxt_subsw_M0_wRn(rd1);
            break;
        case 0x8:
            gen_op_iwmmxt_subnl_M0_wRn(rd1);
            break;
        case 0x9:
            gen_op_iwmmxt_subul_M0_wRn(rd1);
            break;
        case 0xb:
            gen_op_iwmmxt_subsl_M0_wRn(rd1);
            break;
        default:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x01e: case 0x11e: case 0x21e: case 0x31e:	/* WSHUFH */
    case 0x41e: case 0x51e: case 0x61e: case 0x71e:
    case 0x81e: case 0x91e: case 0xa1e: case 0xb1e:
    case 0xc1e: case 0xd1e: case 0xe1e: case 0xf1e:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2218 2219 2220
        tmp = tcg_const_i32(((insn >> 16) & 0xf0) | (insn & 0x0f));
        gen_helper_iwmmxt_shufh(cpu_M0, cpu_env, cpu_M0, tmp);
        tcg_temp_free(tmp);
2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x018: case 0x118: case 0x218: case 0x318:	/* WADD */
    case 0x418: case 0x518: case 0x618: case 0x718:
    case 0x818: case 0x918: case 0xa18: case 0xb18:
    case 0xc18: case 0xd18: case 0xe18: case 0xf18:
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 20) & 0xf) {
        case 0x0:
            gen_op_iwmmxt_addnb_M0_wRn(rd1);
            break;
        case 0x1:
            gen_op_iwmmxt_addub_M0_wRn(rd1);
            break;
        case 0x3:
            gen_op_iwmmxt_addsb_M0_wRn(rd1);
            break;
        case 0x4:
            gen_op_iwmmxt_addnw_M0_wRn(rd1);
            break;
        case 0x5:
            gen_op_iwmmxt_adduw_M0_wRn(rd1);
            break;
        case 0x7:
            gen_op_iwmmxt_addsw_M0_wRn(rd1);
            break;
        case 0x8:
            gen_op_iwmmxt_addnl_M0_wRn(rd1);
            break;
        case 0x9:
            gen_op_iwmmxt_addul_M0_wRn(rd1);
            break;
        case 0xb:
            gen_op_iwmmxt_addsl_M0_wRn(rd1);
            break;
        default:
            return 1;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x008: case 0x108: case 0x208: case 0x308:	/* WPACK */
    case 0x408: case 0x508: case 0x608: case 0x708:
    case 0x808: case 0x908: case 0xa08: case 0xb08:
    case 0xc08: case 0xd08: case 0xe08: case 0xf08:
2272 2273
        if (!(insn & (1 << 20)) || ((insn >> 22) & 3) == 0)
            return 1;
2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
        switch ((insn >> 22) & 3) {
        case 1:
            if (insn & (1 << 21))
                gen_op_iwmmxt_packsw_M0_wRn(rd1);
            else
                gen_op_iwmmxt_packuw_M0_wRn(rd1);
            break;
        case 2:
            if (insn & (1 << 21))
                gen_op_iwmmxt_packsl_M0_wRn(rd1);
            else
                gen_op_iwmmxt_packul_M0_wRn(rd1);
            break;
        case 3:
            if (insn & (1 << 21))
                gen_op_iwmmxt_packsq_M0_wRn(rd1);
            else
                gen_op_iwmmxt_packuq_M0_wRn(rd1);
            break;
        }
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        gen_op_iwmmxt_set_cup();
        break;
    case 0x201: case 0x203: case 0x205: case 0x207:
    case 0x209: case 0x20b: case 0x20d: case 0x20f:
    case 0x211: case 0x213: case 0x215: case 0x217:
    case 0x219: case 0x21b: case 0x21d: case 0x21f:
        wrd = (insn >> 5) & 0xf;
        rd0 = (insn >> 12) & 0xf;
        rd1 = (insn >> 0) & 0xf;
        if (rd0 == 0xf || rd1 == 0xf)
            return 1;
        gen_op_iwmmxt_movq_M0_wRn(wrd);
2312 2313
        tmp = load_reg(s, rd0);
        tmp2 = load_reg(s, rd1);
2314 2315
        switch ((insn >> 16) & 0xf) {
        case 0x0:					/* TMIA */
2316
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2317 2318
            break;
        case 0x8:					/* TMIAPH */
2319
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2320 2321 2322
            break;
        case 0xc: case 0xd: case 0xe: case 0xf:		/* TMIAxy */
            if (insn & (1 << 16))
2323
                tcg_gen_shri_i32(tmp, tmp, 16);
2324
            if (insn & (1 << 17))
2325 2326
                tcg_gen_shri_i32(tmp2, tmp2, 16);
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2327 2328
            break;
        default:
2329 2330
            dead_tmp(tmp2);
            dead_tmp(tmp);
2331 2332
            return 1;
        }
2333 2334
        dead_tmp(tmp2);
        dead_tmp(tmp);
2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    default:
        return 1;
    }

    return 0;
}

/* Disassemble an XScale DSP instruction.  Returns nonzero if an error occured
   (ie. an undefined instruction).  */
static int disas_dsp_insn(CPUState *env, DisasContext *s, uint32_t insn)
{
    int acc, rd0, rd1, rdhi, rdlo;
2350
    TCGv tmp, tmp2;
2351 2352 2353 2354 2355 2356 2357 2358 2359 2360

    if ((insn & 0x0ff00f10) == 0x0e200010) {
        /* Multiply with Internal Accumulate Format */
        rd0 = (insn >> 12) & 0xf;
        rd1 = insn & 0xf;
        acc = (insn >> 5) & 7;

        if (acc != 0)
            return 1;

2361 2362
        tmp = load_reg(s, rd0);
        tmp2 = load_reg(s, rd1);
2363 2364
        switch ((insn >> 16) & 0xf) {
        case 0x0:					/* MIA */
2365
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2366 2367
            break;
        case 0x8:					/* MIAPH */
2368
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2369 2370 2371 2372 2373 2374
            break;
        case 0xc:					/* MIABB */
        case 0xd:					/* MIABT */
        case 0xe:					/* MIATB */
        case 0xf:					/* MIATT */
            if (insn & (1 << 16))
2375
                tcg_gen_shri_i32(tmp, tmp, 16);
2376
            if (insn & (1 << 17))
2377 2378
                tcg_gen_shri_i32(tmp2, tmp2, 16);
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2379 2380 2381 2382
            break;
        default:
            return 1;
        }
2383 2384
        dead_tmp(tmp2);
        dead_tmp(tmp);
2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399

        gen_op_iwmmxt_movq_wRn_M0(acc);
        return 0;
    }

    if ((insn & 0x0fe00ff8) == 0x0c400000) {
        /* Internal Accumulator Access Format */
        rdhi = (insn >> 16) & 0xf;
        rdlo = (insn >> 12) & 0xf;
        acc = insn & 7;

        if (acc != 0)
            return 1;

        if (insn & ARM_CP_RW_BIT) {			/* MRA */
2400 2401 2402 2403 2404
            iwmmxt_load_reg(cpu_V0, acc);
            tcg_gen_trunc_i64_i32(cpu_R[rdlo], cpu_V0);
            tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
            tcg_gen_trunc_i64_i32(cpu_R[rdhi], cpu_V0);
            tcg_gen_andi_i32(cpu_R[rdhi], cpu_R[rdhi], (1 << (40 - 32)) - 1);
2405
        } else {					/* MAR */
2406 2407
            tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
            iwmmxt_store_reg(cpu_V0, acc);
2408 2409 2410 2411 2412 2413 2414
        }
        return 0;
    }

    return 1;
}

2415 2416 2417 2418
/* Disassemble system coprocessor instruction.  Return nonzero if
   instruction is not defined.  */
static int disas_cp_insn(CPUState *env, DisasContext *s, uint32_t insn)
{
2419
    TCGv tmp, tmp2;
2420 2421 2422 2423 2424 2425
    uint32_t rd = (insn >> 12) & 0xf;
    uint32_t cp = (insn >> 8) & 0xf;
    if (IS_USER(s)) {
        return 1;
    }

2426
    if (insn & ARM_CP_RW_BIT) {
2427 2428
        if (!env->cp[cp].cp_read)
            return 1;
P
pbrook 已提交
2429 2430
        gen_set_pc_im(s->pc);
        tmp = new_tmp();
2431 2432 2433
        tmp2 = tcg_const_i32(insn);
        gen_helper_get_cp(tmp, cpu_env, tmp2);
        tcg_temp_free(tmp2);
P
pbrook 已提交
2434
        store_reg(s, rd, tmp);
2435 2436 2437
    } else {
        if (!env->cp[cp].cp_write)
            return 1;
P
pbrook 已提交
2438 2439
        gen_set_pc_im(s->pc);
        tmp = load_reg(s, rd);
2440 2441 2442
        tmp2 = tcg_const_i32(insn);
        gen_helper_set_cp(cpu_env, tmp2, tmp);
        tcg_temp_free(tmp2);
B
balrog 已提交
2443
        dead_tmp(tmp);
2444 2445 2446 2447
    }
    return 0;
}

P
pbrook 已提交
2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467
static int cp15_user_ok(uint32_t insn)
{
    int cpn = (insn >> 16) & 0xf;
    int cpm = insn & 0xf;
    int op = ((insn >> 5) & 7) | ((insn >> 18) & 0x38);

    if (cpn == 13 && cpm == 0) {
        /* TLS register.  */
        if (op == 2 || (op == 3 && (insn & ARM_CP_RW_BIT)))
            return 1;
    }
    if (cpn == 7) {
        /* ISB, DSB, DMB.  */
        if ((cpm == 5 && op == 4)
                || (cpm == 10 && (op == 4 || op == 5)))
            return 1;
    }
    return 0;
}

B
bellard 已提交
2468 2469
/* Disassemble system coprocessor (cp15) instruction.  Return nonzero if
   instruction is not defined.  */
2470
static int disas_cp15_insn(CPUState *env, DisasContext *s, uint32_t insn)
B
bellard 已提交
2471 2472
{
    uint32_t rd;
2473
    TCGv tmp, tmp2;
B
bellard 已提交
2474

P
pbrook 已提交
2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491
    /* M profile cores use memory mapped registers instead of cp15.  */
    if (arm_feature(env, ARM_FEATURE_M))
	return 1;

    if ((insn & (1 << 25)) == 0) {
        if (insn & (1 << 20)) {
            /* mrrc */
            return 1;
        }
        /* mcrr.  Used for block cache operations, so implement as no-op.  */
        return 0;
    }
    if ((insn & (1 << 4)) == 0) {
        /* cdp */
        return 1;
    }
    if (IS_USER(s) && !cp15_user_ok(insn)) {
B
bellard 已提交
2492 2493
        return 1;
    }
B
bellard 已提交
2494 2495 2496
    if ((insn & 0x0fff0fff) == 0x0e070f90
        || (insn & 0x0fff0fff) == 0x0e070f58) {
        /* Wait for interrupt.  */
P
pbrook 已提交
2497
        gen_set_pc_im(s->pc);
P
pbrook 已提交
2498
        s->is_jmp = DISAS_WFI;
B
bellard 已提交
2499 2500
        return 0;
    }
B
bellard 已提交
2501
    rd = (insn >> 12) & 0xf;
2502
    tmp2 = tcg_const_i32(insn);
2503
    if (insn & ARM_CP_RW_BIT) {
P
pbrook 已提交
2504
        tmp = new_tmp();
2505
        gen_helper_get_cp15(tmp, cpu_env, tmp2);
B
bellard 已提交
2506 2507
        /* If the destination register is r15 then sets condition codes.  */
        if (rd != 15)
P
pbrook 已提交
2508 2509 2510
            store_reg(s, rd, tmp);
        else
            dead_tmp(tmp);
B
bellard 已提交
2511
    } else {
P
pbrook 已提交
2512
        tmp = load_reg(s, rd);
2513
        gen_helper_set_cp15(cpu_env, tmp2, tmp);
P
pbrook 已提交
2514
        dead_tmp(tmp);
2515 2516 2517 2518 2519 2520
        /* Normally we would always end the TB here, but Linux
         * arch/arm/mach-pxa/sleep.S expects two instructions following
         * an MMU enable to execute from cache.  Imitate this behaviour.  */
        if (!arm_feature(env, ARM_FEATURE_XSCALE) ||
                (insn & 0x0fff0fff) != 0x0e010f10)
            gen_lookup_tb(s);
B
bellard 已提交
2521
    }
2522
    tcg_temp_free_i32(tmp2);
B
bellard 已提交
2523 2524 2525
    return 0;
}

P
pbrook 已提交
2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545
#define VFP_REG_SHR(x, n) (((n) > 0) ? (x) >> (n) : (x) << -(n))
#define VFP_SREG(insn, bigbit, smallbit) \
  ((VFP_REG_SHR(insn, bigbit - 1) & 0x1e) | (((insn) >> (smallbit)) & 1))
#define VFP_DREG(reg, insn, bigbit, smallbit) do { \
    if (arm_feature(env, ARM_FEATURE_VFP3)) { \
        reg = (((insn) >> (bigbit)) & 0x0f) \
              | (((insn) >> ((smallbit) - 4)) & 0x10); \
    } else { \
        if (insn & (1 << (smallbit))) \
            return 1; \
        reg = ((insn) >> (bigbit)) & 0x0f; \
    }} while (0)

#define VFP_SREG_D(insn) VFP_SREG(insn, 12, 22)
#define VFP_DREG_D(reg, insn) VFP_DREG(reg, insn, 12, 22)
#define VFP_SREG_N(insn) VFP_SREG(insn, 16,  7)
#define VFP_DREG_N(reg, insn) VFP_DREG(reg, insn, 16,  7)
#define VFP_SREG_M(insn) VFP_SREG(insn,  0,  5)
#define VFP_DREG_M(reg, insn) VFP_DREG(reg, insn,  0,  5)

P
pbrook 已提交
2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559
/* Move between integer and VFP cores.  */
static TCGv gen_vfp_mrs(void)
{
    TCGv tmp = new_tmp();
    tcg_gen_mov_i32(tmp, cpu_F0s);
    return tmp;
}

static void gen_vfp_msr(TCGv tmp)
{
    tcg_gen_mov_i32(cpu_F0s, tmp);
    dead_tmp(tmp);
}

P
pbrook 已提交
2560 2561 2562 2563 2564 2565
static inline int
vfp_enabled(CPUState * env)
{
    return ((env->vfp.xregs[ARM_VFP_FPEXC] & (1 << 30)) != 0);
}

P
pbrook 已提交
2566 2567 2568 2569 2570
static void gen_neon_dup_u8(TCGv var, int shift)
{
    TCGv tmp = new_tmp();
    if (shift)
        tcg_gen_shri_i32(var, var, shift);
P
pbrook 已提交
2571
    tcg_gen_ext8u_i32(var, var);
P
pbrook 已提交
2572 2573 2574 2575 2576 2577 2578 2579 2580 2581
    tcg_gen_shli_i32(tmp, var, 8);
    tcg_gen_or_i32(var, var, tmp);
    tcg_gen_shli_i32(tmp, var, 16);
    tcg_gen_or_i32(var, var, tmp);
    dead_tmp(tmp);
}

static void gen_neon_dup_low16(TCGv var)
{
    TCGv tmp = new_tmp();
P
pbrook 已提交
2582
    tcg_gen_ext16u_i32(var, var);
P
pbrook 已提交
2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596
    tcg_gen_shli_i32(tmp, var, 16);
    tcg_gen_or_i32(var, var, tmp);
    dead_tmp(tmp);
}

static void gen_neon_dup_high16(TCGv var)
{
    TCGv tmp = new_tmp();
    tcg_gen_andi_i32(var, var, 0xffff0000);
    tcg_gen_shri_i32(tmp, var, 16);
    tcg_gen_or_i32(var, var, tmp);
    dead_tmp(tmp);
}

B
bellard 已提交
2597 2598 2599 2600 2601 2602
/* Disassemble a VFP instruction.  Returns nonzero if an error occured
   (ie. an undefined instruction).  */
static int disas_vfp_insn(CPUState * env, DisasContext *s, uint32_t insn)
{
    uint32_t rd, rn, rm, op, i, n, offset, delta_d, delta_m, bank_mask;
    int dp, veclen;
2603
    TCGv addr;
P
pbrook 已提交
2604
    TCGv tmp;
P
pbrook 已提交
2605
    TCGv tmp2;
B
bellard 已提交
2606

P
pbrook 已提交
2607 2608 2609
    if (!arm_feature(env, ARM_FEATURE_VFP))
        return 1;

P
pbrook 已提交
2610 2611
    if (!vfp_enabled(env)) {
        /* VFP disabled.  Only allow fmxr/fmrx to/from some control regs.  */
P
pbrook 已提交
2612 2613 2614
        if ((insn & 0x0fe00fff) != 0x0ee00a10)
            return 1;
        rn = (insn >> 16) & 0xf;
P
pbrook 已提交
2615 2616
        if (rn != ARM_VFP_FPSID && rn != ARM_VFP_FPEXC
            && rn != ARM_VFP_MVFR1 && rn != ARM_VFP_MVFR0)
P
pbrook 已提交
2617 2618
            return 1;
    }
B
bellard 已提交
2619 2620 2621 2622 2623 2624 2625
    dp = ((insn & 0xf00) == 0xb00);
    switch ((insn >> 24) & 0xf) {
    case 0xe:
        if (insn & (1 << 4)) {
            /* single register transfer */
            rd = (insn >> 12) & 0xf;
            if (dp) {
P
pbrook 已提交
2626 2627 2628 2629 2630
                int size;
                int pass;

                VFP_DREG_N(rn, insn);
                if (insn & 0xf)
B
bellard 已提交
2631
                    return 1;
P
pbrook 已提交
2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646
                if (insn & 0x00c00060
                    && !arm_feature(env, ARM_FEATURE_NEON))
                    return 1;

                pass = (insn >> 21) & 1;
                if (insn & (1 << 22)) {
                    size = 0;
                    offset = ((insn >> 5) & 3) * 8;
                } else if (insn & (1 << 5)) {
                    size = 1;
                    offset = (insn & (1 << 6)) ? 16 : 0;
                } else {
                    size = 2;
                    offset = 0;
                }
2647
                if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
2648
                    /* vfp->arm */
P
pbrook 已提交
2649
                    tmp = neon_load_reg(rn, pass);
P
pbrook 已提交
2650 2651 2652
                    switch (size) {
                    case 0:
                        if (offset)
P
pbrook 已提交
2653
                            tcg_gen_shri_i32(tmp, tmp, offset);
P
pbrook 已提交
2654
                        if (insn & (1 << 23))
P
pbrook 已提交
2655
                            gen_uxtb(tmp);
P
pbrook 已提交
2656
                        else
P
pbrook 已提交
2657
                            gen_sxtb(tmp);
P
pbrook 已提交
2658 2659 2660 2661
                        break;
                    case 1:
                        if (insn & (1 << 23)) {
                            if (offset) {
P
pbrook 已提交
2662
                                tcg_gen_shri_i32(tmp, tmp, 16);
P
pbrook 已提交
2663
                            } else {
P
pbrook 已提交
2664
                                gen_uxth(tmp);
P
pbrook 已提交
2665 2666 2667
                            }
                        } else {
                            if (offset) {
P
pbrook 已提交
2668
                                tcg_gen_sari_i32(tmp, tmp, 16);
P
pbrook 已提交
2669
                            } else {
P
pbrook 已提交
2670
                                gen_sxth(tmp);
P
pbrook 已提交
2671 2672 2673 2674 2675 2676
                            }
                        }
                        break;
                    case 2:
                        break;
                    }
P
pbrook 已提交
2677
                    store_reg(s, rd, tmp);
B
bellard 已提交
2678 2679
                } else {
                    /* arm->vfp */
P
pbrook 已提交
2680
                    tmp = load_reg(s, rd);
P
pbrook 已提交
2681 2682 2683
                    if (insn & (1 << 23)) {
                        /* VDUP */
                        if (size == 0) {
P
pbrook 已提交
2684
                            gen_neon_dup_u8(tmp, 0);
P
pbrook 已提交
2685
                        } else if (size == 1) {
P
pbrook 已提交
2686
                            gen_neon_dup_low16(tmp);
P
pbrook 已提交
2687
                        }
P
pbrook 已提交
2688 2689 2690 2691 2692 2693
                        for (n = 0; n <= pass * 2; n++) {
                            tmp2 = new_tmp();
                            tcg_gen_mov_i32(tmp2, tmp);
                            neon_store_reg(rn, n, tmp2);
                        }
                        neon_store_reg(rn, n, tmp);
P
pbrook 已提交
2694 2695 2696 2697
                    } else {
                        /* VMOV */
                        switch (size) {
                        case 0:
P
pbrook 已提交
2698 2699 2700
                            tmp2 = neon_load_reg(rn, pass);
                            gen_bfi(tmp, tmp2, tmp, offset, 0xff);
                            dead_tmp(tmp2);
P
pbrook 已提交
2701 2702
                            break;
                        case 1:
P
pbrook 已提交
2703 2704 2705
                            tmp2 = neon_load_reg(rn, pass);
                            gen_bfi(tmp, tmp2, tmp, offset, 0xffff);
                            dead_tmp(tmp2);
P
pbrook 已提交
2706 2707 2708 2709
                            break;
                        case 2:
                            break;
                        }
P
pbrook 已提交
2710
                        neon_store_reg(rn, pass, tmp);
P
pbrook 已提交
2711
                    }
B
bellard 已提交
2712
                }
P
pbrook 已提交
2713 2714 2715 2716
            } else { /* !dp */
                if ((insn & 0x6f) != 0x00)
                    return 1;
                rn = VFP_SREG_N(insn);
2717
                if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
2718 2719 2720
                    /* vfp->arm */
                    if (insn & (1 << 21)) {
                        /* system register */
P
pbrook 已提交
2721
                        rn >>= 1;
P
pbrook 已提交
2722

B
bellard 已提交
2723
                        switch (rn) {
P
pbrook 已提交
2724
                        case ARM_VFP_FPSID:
P
pbrook 已提交
2725
                            /* VFP2 allows access to FSID from userspace.
P
pbrook 已提交
2726 2727 2728 2729 2730
                               VFP3 restricts all id registers to privileged
                               accesses.  */
                            if (IS_USER(s)
                                && arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2731
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2732
                            break;
P
pbrook 已提交
2733
                        case ARM_VFP_FPEXC:
P
pbrook 已提交
2734 2735
                            if (IS_USER(s))
                                return 1;
P
pbrook 已提交
2736
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2737
                            break;
P
pbrook 已提交
2738 2739
                        case ARM_VFP_FPINST:
                        case ARM_VFP_FPINST2:
P
pbrook 已提交
2740 2741 2742 2743
                            /* Not present in VFP3.  */
                            if (IS_USER(s)
                                || arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2744
                            tmp = load_cpu_field(vfp.xregs[rn]);
B
bellard 已提交
2745
                            break;
P
pbrook 已提交
2746
                        case ARM_VFP_FPSCR:
2747
                            if (rd == 15) {
P
pbrook 已提交
2748 2749 2750 2751 2752 2753
                                tmp = load_cpu_field(vfp.xregs[ARM_VFP_FPSCR]);
                                tcg_gen_andi_i32(tmp, tmp, 0xf0000000);
                            } else {
                                tmp = new_tmp();
                                gen_helper_vfp_get_fpscr(tmp, cpu_env);
                            }
B
bellard 已提交
2754
                            break;
P
pbrook 已提交
2755 2756 2757 2758 2759
                        case ARM_VFP_MVFR0:
                        case ARM_VFP_MVFR1:
                            if (IS_USER(s)
                                || !arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2760
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2761
                            break;
B
bellard 已提交
2762 2763 2764 2765 2766
                        default:
                            return 1;
                        }
                    } else {
                        gen_mov_F0_vreg(0, rn);
P
pbrook 已提交
2767
                        tmp = gen_vfp_mrs();
B
bellard 已提交
2768 2769
                    }
                    if (rd == 15) {
B
bellard 已提交
2770
                        /* Set the 4 flag bits in the CPSR.  */
P
pbrook 已提交
2771 2772 2773 2774 2775
                        gen_set_nzcv(tmp);
                        dead_tmp(tmp);
                    } else {
                        store_reg(s, rd, tmp);
                    }
B
bellard 已提交
2776 2777
                } else {
                    /* arm->vfp */
P
pbrook 已提交
2778
                    tmp = load_reg(s, rd);
B
bellard 已提交
2779
                    if (insn & (1 << 21)) {
P
pbrook 已提交
2780
                        rn >>= 1;
B
bellard 已提交
2781 2782
                        /* system register */
                        switch (rn) {
P
pbrook 已提交
2783
                        case ARM_VFP_FPSID:
P
pbrook 已提交
2784 2785
                        case ARM_VFP_MVFR0:
                        case ARM_VFP_MVFR1:
B
bellard 已提交
2786 2787
                            /* Writes are ignored.  */
                            break;
P
pbrook 已提交
2788
                        case ARM_VFP_FPSCR:
P
pbrook 已提交
2789 2790
                            gen_helper_vfp_set_fpscr(cpu_env, tmp);
                            dead_tmp(tmp);
B
bellard 已提交
2791
                            gen_lookup_tb(s);
B
bellard 已提交
2792
                            break;
P
pbrook 已提交
2793
                        case ARM_VFP_FPEXC:
P
pbrook 已提交
2794 2795
                            if (IS_USER(s))
                                return 1;
P
pbrook 已提交
2796
                            store_cpu_field(tmp, vfp.xregs[rn]);
P
pbrook 已提交
2797 2798 2799 2800
                            gen_lookup_tb(s);
                            break;
                        case ARM_VFP_FPINST:
                        case ARM_VFP_FPINST2:
P
pbrook 已提交
2801
                            store_cpu_field(tmp, vfp.xregs[rn]);
P
pbrook 已提交
2802
                            break;
B
bellard 已提交
2803 2804 2805 2806
                        default:
                            return 1;
                        }
                    } else {
P
pbrook 已提交
2807
                        gen_vfp_msr(tmp);
B
bellard 已提交
2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821
                        gen_mov_vreg_F0(0, rn);
                    }
                }
            }
        } else {
            /* data processing */
            /* The opcode is in bits 23, 21, 20 and 6.  */
            op = ((insn >> 20) & 8) | ((insn >> 19) & 6) | ((insn >> 6) & 1);
            if (dp) {
                if (op == 15) {
                    /* rn is opcode */
                    rn = ((insn >> 15) & 0x1e) | ((insn >> 7) & 1);
                } else {
                    /* rn is register number */
P
pbrook 已提交
2822
                    VFP_DREG_N(rn, insn);
B
bellard 已提交
2823 2824 2825 2826
                }

                if (op == 15 && (rn == 15 || rn > 17)) {
                    /* Integer or single precision destination.  */
P
pbrook 已提交
2827
                    rd = VFP_SREG_D(insn);
B
bellard 已提交
2828
                } else {
P
pbrook 已提交
2829
                    VFP_DREG_D(rd, insn);
B
bellard 已提交
2830 2831 2832 2833 2834 2835
                }

                if (op == 15 && (rn == 16 || rn == 17)) {
                    /* Integer source.  */
                    rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
                } else {
P
pbrook 已提交
2836
                    VFP_DREG_M(rm, insn);
B
bellard 已提交
2837 2838
                }
            } else {
P
pbrook 已提交
2839
                rn = VFP_SREG_N(insn);
B
bellard 已提交
2840 2841
                if (op == 15 && rn == 15) {
                    /* Double precision destination.  */
P
pbrook 已提交
2842 2843 2844 2845 2846
                    VFP_DREG_D(rd, insn);
                } else {
                    rd = VFP_SREG_D(insn);
                }
                rm = VFP_SREG_M(insn);
B
bellard 已提交
2847 2848 2849 2850 2851 2852 2853 2854 2855 2856
            }

            veclen = env->vfp.vec_len;
            if (op == 15 && rn > 3)
                veclen = 0;

            /* Shut up compiler warnings.  */
            delta_m = 0;
            delta_d = 0;
            bank_mask = 0;
2857

B
bellard 已提交
2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903
            if (veclen > 0) {
                if (dp)
                    bank_mask = 0xc;
                else
                    bank_mask = 0x18;

                /* Figure out what type of vector operation this is.  */
                if ((rd & bank_mask) == 0) {
                    /* scalar */
                    veclen = 0;
                } else {
                    if (dp)
                        delta_d = (env->vfp.vec_stride >> 1) + 1;
                    else
                        delta_d = env->vfp.vec_stride + 1;

                    if ((rm & bank_mask) == 0) {
                        /* mixed scalar/vector */
                        delta_m = 0;
                    } else {
                        /* vector */
                        delta_m = delta_d;
                    }
                }
            }

            /* Load the initial operands.  */
            if (op == 15) {
                switch (rn) {
                case 16:
                case 17:
                    /* Integer source */
                    gen_mov_F0_vreg(0, rm);
                    break;
                case 8:
                case 9:
                    /* Compare */
                    gen_mov_F0_vreg(dp, rd);
                    gen_mov_F1_vreg(dp, rm);
                    break;
                case 10:
                case 11:
                    /* Compare with zero */
                    gen_mov_F0_vreg(dp, rd);
                    gen_vfp_F1_ld0(dp);
                    break;
P
pbrook 已提交
2904 2905 2906 2907
                case 20:
                case 21:
                case 22:
                case 23:
P
pbrook 已提交
2908 2909 2910 2911
                case 28:
                case 29:
                case 30:
                case 31:
P
pbrook 已提交
2912 2913 2914
                    /* Source and destination the same.  */
                    gen_mov_F0_vreg(dp, rd);
                    break;
B
bellard 已提交
2915 2916 2917
                default:
                    /* One source operand.  */
                    gen_mov_F0_vreg(dp, rm);
P
pbrook 已提交
2918
                    break;
B
bellard 已提交
2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947
                }
            } else {
                /* Two source operands.  */
                gen_mov_F0_vreg(dp, rn);
                gen_mov_F1_vreg(dp, rm);
            }

            for (;;) {
                /* Perform the calculation.  */
                switch (op) {
                case 0: /* mac: fd + (fn * fm) */
                    gen_vfp_mul(dp);
                    gen_mov_F1_vreg(dp, rd);
                    gen_vfp_add(dp);
                    break;
                case 1: /* nmac: fd - (fn * fm) */
                    gen_vfp_mul(dp);
                    gen_vfp_neg(dp);
                    gen_mov_F1_vreg(dp, rd);
                    gen_vfp_add(dp);
                    break;
                case 2: /* msc: -fd + (fn * fm) */
                    gen_vfp_mul(dp);
                    gen_mov_F1_vreg(dp, rd);
                    gen_vfp_sub(dp);
                    break;
                case 3: /* nmsc: -fd - (fn * fm)  */
                    gen_vfp_mul(dp);
                    gen_vfp_neg(dp);
P
pbrook 已提交
2948 2949
                    gen_mov_F1_vreg(dp, rd);
                    gen_vfp_sub(dp);
B
bellard 已提交
2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966
                    break;
                case 4: /* mul: fn * fm */
                    gen_vfp_mul(dp);
                    break;
                case 5: /* nmul: -(fn * fm) */
                    gen_vfp_mul(dp);
                    gen_vfp_neg(dp);
                    break;
                case 6: /* add: fn + fm */
                    gen_vfp_add(dp);
                    break;
                case 7: /* sub: fn - fm */
                    gen_vfp_sub(dp);
                    break;
                case 8: /* div: fn / fm */
                    gen_vfp_div(dp);
                    break;
P
pbrook 已提交
2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978
                case 14: /* fconst */
                    if (!arm_feature(env, ARM_FEATURE_VFP3))
                      return 1;

                    n = (insn << 12) & 0x80000000;
                    i = ((insn >> 12) & 0x70) | (insn & 0xf);
                    if (dp) {
                        if (i & 0x40)
                            i |= 0x3f80;
                        else
                            i |= 0x4000;
                        n |= i << 16;
P
pbrook 已提交
2979
                        tcg_gen_movi_i64(cpu_F0d, ((uint64_t)n) << 32);
P
pbrook 已提交
2980 2981 2982 2983 2984 2985
                    } else {
                        if (i & 0x40)
                            i |= 0x780;
                        else
                            i |= 0x800;
                        n |= i << 19;
B
balrog 已提交
2986
                        tcg_gen_movi_i32(cpu_F0s, n);
P
pbrook 已提交
2987 2988
                    }
                    break;
B
bellard 已提交
2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017
                case 15: /* extension space */
                    switch (rn) {
                    case 0: /* cpy */
                        /* no-op */
                        break;
                    case 1: /* abs */
                        gen_vfp_abs(dp);
                        break;
                    case 2: /* neg */
                        gen_vfp_neg(dp);
                        break;
                    case 3: /* sqrt */
                        gen_vfp_sqrt(dp);
                        break;
                    case 8: /* cmp */
                        gen_vfp_cmp(dp);
                        break;
                    case 9: /* cmpe */
                        gen_vfp_cmpe(dp);
                        break;
                    case 10: /* cmpz */
                        gen_vfp_cmp(dp);
                        break;
                    case 11: /* cmpez */
                        gen_vfp_F1_ld0(dp);
                        gen_vfp_cmpe(dp);
                        break;
                    case 15: /* single<->double conversion */
                        if (dp)
P
pbrook 已提交
3018
                            gen_helper_vfp_fcvtsd(cpu_F0s, cpu_F0d, cpu_env);
B
bellard 已提交
3019
                        else
P
pbrook 已提交
3020
                            gen_helper_vfp_fcvtds(cpu_F0d, cpu_F0s, cpu_env);
B
bellard 已提交
3021 3022 3023 3024 3025 3026 3027
                        break;
                    case 16: /* fuito */
                        gen_vfp_uito(dp);
                        break;
                    case 17: /* fsito */
                        gen_vfp_sito(dp);
                        break;
P
pbrook 已提交
3028 3029 3030
                    case 20: /* fshto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3031
                        gen_vfp_shto(dp, 16 - rm);
P
pbrook 已提交
3032 3033 3034 3035
                        break;
                    case 21: /* fslto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3036
                        gen_vfp_slto(dp, 32 - rm);
P
pbrook 已提交
3037 3038 3039 3040
                        break;
                    case 22: /* fuhto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3041
                        gen_vfp_uhto(dp, 16 - rm);
P
pbrook 已提交
3042 3043 3044 3045
                        break;
                    case 23: /* fulto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3046
                        gen_vfp_ulto(dp, 32 - rm);
P
pbrook 已提交
3047
                        break;
B
bellard 已提交
3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059
                    case 24: /* ftoui */
                        gen_vfp_toui(dp);
                        break;
                    case 25: /* ftouiz */
                        gen_vfp_touiz(dp);
                        break;
                    case 26: /* ftosi */
                        gen_vfp_tosi(dp);
                        break;
                    case 27: /* ftosiz */
                        gen_vfp_tosiz(dp);
                        break;
P
pbrook 已提交
3060 3061 3062
                    case 28: /* ftosh */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3063
                        gen_vfp_tosh(dp, 16 - rm);
P
pbrook 已提交
3064 3065 3066 3067
                        break;
                    case 29: /* ftosl */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3068
                        gen_vfp_tosl(dp, 32 - rm);
P
pbrook 已提交
3069 3070 3071 3072
                        break;
                    case 30: /* ftouh */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3073
                        gen_vfp_touh(dp, 16 - rm);
P
pbrook 已提交
3074 3075 3076 3077
                        break;
                    case 31: /* ftoul */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3078
                        gen_vfp_toul(dp, 32 - rm);
P
pbrook 已提交
3079
                        break;
B
bellard 已提交
3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140
                    default: /* undefined */
                        printf ("rn:%d\n", rn);
                        return 1;
                    }
                    break;
                default: /* undefined */
                    printf ("op:%d\n", op);
                    return 1;
                }

                /* Write back the result.  */
                if (op == 15 && (rn >= 8 && rn <= 11))
                    ; /* Comparison, do nothing.  */
                else if (op == 15 && rn > 17)
                    /* Integer result.  */
                    gen_mov_vreg_F0(0, rd);
                else if (op == 15 && rn == 15)
                    /* conversion */
                    gen_mov_vreg_F0(!dp, rd);
                else
                    gen_mov_vreg_F0(dp, rd);

                /* break out of the loop if we have finished  */
                if (veclen == 0)
                    break;

                if (op == 15 && delta_m == 0) {
                    /* single source one-many */
                    while (veclen--) {
                        rd = ((rd + delta_d) & (bank_mask - 1))
                             | (rd & bank_mask);
                        gen_mov_vreg_F0(dp, rd);
                    }
                    break;
                }
                /* Setup the next operands.  */
                veclen--;
                rd = ((rd + delta_d) & (bank_mask - 1))
                     | (rd & bank_mask);

                if (op == 15) {
                    /* One source operand.  */
                    rm = ((rm + delta_m) & (bank_mask - 1))
                         | (rm & bank_mask);
                    gen_mov_F0_vreg(dp, rm);
                } else {
                    /* Two source operands.  */
                    rn = ((rn + delta_d) & (bank_mask - 1))
                         | (rn & bank_mask);
                    gen_mov_F0_vreg(dp, rn);
                    if (delta_m) {
                        rm = ((rm + delta_m) & (bank_mask - 1))
                             | (rm & bank_mask);
                        gen_mov_F1_vreg(dp, rm);
                    }
                }
            }
        }
        break;
    case 0xc:
    case 0xd:
P
pbrook 已提交
3141
        if (dp && (insn & 0x03e00000) == 0x00400000) {
B
bellard 已提交
3142 3143 3144 3145
            /* two-register transfer */
            rn = (insn >> 16) & 0xf;
            rd = (insn >> 12) & 0xf;
            if (dp) {
P
pbrook 已提交
3146 3147 3148 3149
                VFP_DREG_M(rm, insn);
            } else {
                rm = VFP_SREG_M(insn);
            }
B
bellard 已提交
3150

3151
            if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
3152 3153
                /* vfp->arm */
                if (dp) {
P
pbrook 已提交
3154 3155 3156 3157 3158 3159
                    gen_mov_F0_vreg(0, rm * 2);
                    tmp = gen_vfp_mrs();
                    store_reg(s, rd, tmp);
                    gen_mov_F0_vreg(0, rm * 2 + 1);
                    tmp = gen_vfp_mrs();
                    store_reg(s, rn, tmp);
B
bellard 已提交
3160 3161
                } else {
                    gen_mov_F0_vreg(0, rm);
P
pbrook 已提交
3162 3163
                    tmp = gen_vfp_mrs();
                    store_reg(s, rn, tmp);
B
bellard 已提交
3164
                    gen_mov_F0_vreg(0, rm + 1);
P
pbrook 已提交
3165 3166
                    tmp = gen_vfp_mrs();
                    store_reg(s, rd, tmp);
B
bellard 已提交
3167 3168 3169 3170
                }
            } else {
                /* arm->vfp */
                if (dp) {
P
pbrook 已提交
3171 3172 3173 3174 3175 3176
                    tmp = load_reg(s, rd);
                    gen_vfp_msr(tmp);
                    gen_mov_vreg_F0(0, rm * 2);
                    tmp = load_reg(s, rn);
                    gen_vfp_msr(tmp);
                    gen_mov_vreg_F0(0, rm * 2 + 1);
B
bellard 已提交
3177
                } else {
P
pbrook 已提交
3178 3179
                    tmp = load_reg(s, rn);
                    gen_vfp_msr(tmp);
B
bellard 已提交
3180
                    gen_mov_vreg_F0(0, rm);
P
pbrook 已提交
3181 3182
                    tmp = load_reg(s, rd);
                    gen_vfp_msr(tmp);
B
bellard 已提交
3183 3184 3185 3186 3187 3188 3189
                    gen_mov_vreg_F0(0, rm + 1);
                }
            }
        } else {
            /* Load/store */
            rn = (insn >> 16) & 0xf;
            if (dp)
P
pbrook 已提交
3190
                VFP_DREG_D(rd, insn);
B
bellard 已提交
3191
            else
P
pbrook 已提交
3192 3193
                rd = VFP_SREG_D(insn);
            if (s->thumb && rn == 15) {
3194 3195
                addr = new_tmp();
                tcg_gen_movi_i32(addr, s->pc & ~2);
P
pbrook 已提交
3196
            } else {
3197
                addr = load_reg(s, rn);
P
pbrook 已提交
3198
            }
B
bellard 已提交
3199 3200 3201 3202 3203
            if ((insn & 0x01200000) == 0x01000000) {
                /* Single load/store */
                offset = (insn & 0xff) << 2;
                if ((insn & (1 << 23)) == 0)
                    offset = -offset;
3204
                tcg_gen_addi_i32(addr, addr, offset);
B
bellard 已提交
3205
                if (insn & (1 << 20)) {
3206
                    gen_vfp_ld(s, dp, addr);
B
bellard 已提交
3207 3208 3209
                    gen_mov_vreg_F0(dp, rd);
                } else {
                    gen_mov_F0_vreg(dp, rd);
3210
                    gen_vfp_st(s, dp, addr);
B
bellard 已提交
3211
                }
3212
                dead_tmp(addr);
B
bellard 已提交
3213 3214 3215 3216 3217 3218 3219 3220
            } else {
                /* load/store multiple */
                if (dp)
                    n = (insn >> 1) & 0x7f;
                else
                    n = insn & 0xff;

                if (insn & (1 << 24)) /* pre-decrement */
3221
                    tcg_gen_addi_i32(addr, addr, -((insn & 0xff) << 2));
B
bellard 已提交
3222 3223 3224 3225 3226 3227

                if (dp)
                    offset = 8;
                else
                    offset = 4;
                for (i = 0; i < n; i++) {
3228
                    if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
3229
                        /* load */
3230
                        gen_vfp_ld(s, dp, addr);
B
bellard 已提交
3231 3232 3233 3234
                        gen_mov_vreg_F0(dp, rd + i);
                    } else {
                        /* store */
                        gen_mov_F0_vreg(dp, rd + i);
3235
                        gen_vfp_st(s, dp, addr);
B
bellard 已提交
3236
                    }
3237
                    tcg_gen_addi_i32(addr, addr, offset);
B
bellard 已提交
3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248
                }
                if (insn & (1 << 21)) {
                    /* writeback */
                    if (insn & (1 << 24))
                        offset = -offset * n;
                    else if (dp && (insn & 1))
                        offset = 4;
                    else
                        offset = 0;

                    if (offset != 0)
3249 3250 3251 3252
                        tcg_gen_addi_i32(addr, addr, offset);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
B
bellard 已提交
3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263
                }
            }
        }
        break;
    default:
        /* Should never happen.  */
        return 1;
    }
    return 0;
}

3264
static inline void gen_goto_tb(DisasContext *s, int n, uint32_t dest)
B
bellard 已提交
3265
{
3266 3267 3268 3269
    TranslationBlock *tb;

    tb = s->tb;
    if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK)) {
B
bellard 已提交
3270
        tcg_gen_goto_tb(n);
P
pbrook 已提交
3271
        gen_set_pc_im(dest);
B
bellard 已提交
3272
        tcg_gen_exit_tb((long)tb + n);
3273
    } else {
P
pbrook 已提交
3274
        gen_set_pc_im(dest);
B
bellard 已提交
3275
        tcg_gen_exit_tb(0);
3276
    }
B
bellard 已提交
3277 3278
}

B
bellard 已提交
3279 3280
static inline void gen_jmp (DisasContext *s, uint32_t dest)
{
3281
    if (unlikely(s->singlestep_enabled)) {
B
bellard 已提交
3282
        /* An indirect jump so that we still trigger the debug exception.  */
B
bellard 已提交
3283
        if (s->thumb)
P
pbrook 已提交
3284 3285
            dest |= 1;
        gen_bx_im(s, dest);
B
bellard 已提交
3286
    } else {
3287
        gen_goto_tb(s, 0, dest);
B
bellard 已提交
3288 3289 3290 3291
        s->is_jmp = DISAS_TB_JUMP;
    }
}

P
pbrook 已提交
3292
static inline void gen_mulxy(TCGv t0, TCGv t1, int x, int y)
B
bellard 已提交
3293
{
B
bellard 已提交
3294
    if (x)
P
pbrook 已提交
3295
        tcg_gen_sari_i32(t0, t0, 16);
B
bellard 已提交
3296
    else
P
pbrook 已提交
3297
        gen_sxth(t0);
B
bellard 已提交
3298
    if (y)
P
pbrook 已提交
3299
        tcg_gen_sari_i32(t1, t1, 16);
B
bellard 已提交
3300
    else
P
pbrook 已提交
3301 3302
        gen_sxth(t1);
    tcg_gen_mul_i32(t0, t0, t1);
B
bellard 已提交
3303 3304 3305
}

/* Return the mask of PSR bits set by a MSR instruction.  */
P
pbrook 已提交
3306
static uint32_t msr_mask(CPUState *env, DisasContext *s, int flags, int spsr) {
B
bellard 已提交
3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317
    uint32_t mask;

    mask = 0;
    if (flags & (1 << 0))
        mask |= 0xff;
    if (flags & (1 << 1))
        mask |= 0xff00;
    if (flags & (1 << 2))
        mask |= 0xff0000;
    if (flags & (1 << 3))
        mask |= 0xff000000;
P
pbrook 已提交
3318

P
pbrook 已提交
3319
    /* Mask out undefined bits.  */
P
pbrook 已提交
3320 3321
    mask &= ~CPSR_RESERVED;
    if (!arm_feature(env, ARM_FEATURE_V6))
P
pbrook 已提交
3322
        mask &= ~(CPSR_E | CPSR_GE);
P
pbrook 已提交
3323
    if (!arm_feature(env, ARM_FEATURE_THUMB2))
P
pbrook 已提交
3324
        mask &= ~CPSR_IT;
P
pbrook 已提交
3325
    /* Mask out execution state bits.  */
P
pbrook 已提交
3326
    if (!spsr)
P
pbrook 已提交
3327
        mask &= ~CPSR_EXEC;
B
bellard 已提交
3328 3329
    /* Mask out privileged bits.  */
    if (IS_USER(s))
P
pbrook 已提交
3330
        mask &= CPSR_USER;
B
bellard 已提交
3331 3332 3333
    return mask;
}

3334 3335
/* Returns nonzero if access to the PSR is not permitted. Marks t0 as dead. */
static int gen_set_psr(DisasContext *s, uint32_t mask, int spsr, TCGv t0)
B
bellard 已提交
3336
{
P
pbrook 已提交
3337
    TCGv tmp;
B
bellard 已提交
3338 3339 3340 3341
    if (spsr) {
        /* ??? This is also undefined in system mode.  */
        if (IS_USER(s))
            return 1;
P
pbrook 已提交
3342 3343 3344

        tmp = load_cpu_field(spsr);
        tcg_gen_andi_i32(tmp, tmp, ~mask);
3345 3346
        tcg_gen_andi_i32(t0, t0, mask);
        tcg_gen_or_i32(tmp, tmp, t0);
P
pbrook 已提交
3347
        store_cpu_field(tmp, spsr);
B
bellard 已提交
3348
    } else {
3349
        gen_set_cpsr(t0, mask);
B
bellard 已提交
3350
    }
3351
    dead_tmp(t0);
B
bellard 已提交
3352 3353 3354 3355
    gen_lookup_tb(s);
    return 0;
}

3356 3357 3358 3359 3360 3361 3362 3363 3364
/* Returns nonzero if access to the PSR is not permitted.  */
static int gen_set_psr_im(DisasContext *s, uint32_t mask, int spsr, uint32_t val)
{
    TCGv tmp;
    tmp = new_tmp();
    tcg_gen_movi_i32(tmp, val);
    return gen_set_psr(s, mask, spsr, tmp);
}

3365 3366
/* Generate an old-style exception return. Marks pc as dead. */
static void gen_exception_return(DisasContext *s, TCGv pc)
B
bellard 已提交
3367
{
P
pbrook 已提交
3368
    TCGv tmp;
3369
    store_reg(s, 15, pc);
P
pbrook 已提交
3370 3371 3372
    tmp = load_cpu_field(spsr);
    gen_set_cpsr(tmp, 0xffffffff);
    dead_tmp(tmp);
B
bellard 已提交
3373 3374 3375
    s->is_jmp = DISAS_UPDATE;
}

P
pbrook 已提交
3376 3377
/* Generate a v6 exception return.  Marks both values as dead.  */
static void gen_rfe(DisasContext *s, TCGv pc, TCGv cpsr)
B
bellard 已提交
3378
{
P
pbrook 已提交
3379 3380 3381
    gen_set_cpsr(cpsr, 0xffffffff);
    dead_tmp(cpsr);
    store_reg(s, 15, pc);
P
pbrook 已提交
3382 3383
    s->is_jmp = DISAS_UPDATE;
}
3384

P
pbrook 已提交
3385 3386 3387 3388
static inline void
gen_set_condexec (DisasContext *s)
{
    if (s->condexec_mask) {
P
pbrook 已提交
3389 3390 3391
        uint32_t val = (s->condexec_cond << 4) | (s->condexec_mask >> 1);
        TCGv tmp = new_tmp();
        tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
3392
        store_cpu_field(tmp, condexec_bits);
P
pbrook 已提交
3393 3394
    }
}
3395

P
pbrook 已提交
3396 3397 3398 3399
static void gen_nop_hint(DisasContext *s, int val)
{
    switch (val) {
    case 3: /* wfi */
P
pbrook 已提交
3400
        gen_set_pc_im(s->pc);
P
pbrook 已提交
3401 3402 3403 3404 3405 3406 3407 3408 3409
        s->is_jmp = DISAS_WFI;
        break;
    case 2: /* wfe */
    case 4: /* sev */
        /* TODO: Implement SEV and WFE.  May help SMP performance.  */
    default: /* nop */
        break;
    }
}
B
bellard 已提交
3410

P
pbrook 已提交
3411
#define CPU_V001 cpu_V0, cpu_V0, cpu_V1
P
pbrook 已提交
3412

3413
static inline int gen_neon_add(int size, TCGv t0, TCGv t1)
P
pbrook 已提交
3414 3415
{
    switch (size) {
3416 3417 3418
    case 0: gen_helper_neon_add_u8(t0, t0, t1); break;
    case 1: gen_helper_neon_add_u16(t0, t0, t1); break;
    case 2: tcg_gen_add_i32(t0, t0, t1); break;
P
pbrook 已提交
3419 3420 3421 3422 3423
    default: return 1;
    }
    return 0;
}

3424
static inline void gen_neon_rsb(int size, TCGv t0, TCGv t1)
P
pbrook 已提交
3425 3426
{
    switch (size) {
3427 3428 3429
    case 0: gen_helper_neon_sub_u8(t0, t1, t0); break;
    case 1: gen_helper_neon_sub_u16(t0, t1, t0); break;
    case 2: tcg_gen_sub_i32(t0, t1, t0); break;
P
pbrook 已提交
3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448
    default: return;
    }
}

/* 32-bit pairwise ops end up the same as the elementwise versions.  */
#define gen_helper_neon_pmax_s32  gen_helper_neon_max_s32
#define gen_helper_neon_pmax_u32  gen_helper_neon_max_u32
#define gen_helper_neon_pmin_s32  gen_helper_neon_min_s32
#define gen_helper_neon_pmin_u32  gen_helper_neon_min_u32

/* FIXME: This is wrong.  They set the wrong overflow bit.  */
#define gen_helper_neon_qadd_s32(a, e, b, c) gen_helper_add_saturate(a, b, c)
#define gen_helper_neon_qadd_u32(a, e, b, c) gen_helper_add_usaturate(a, b, c)
#define gen_helper_neon_qsub_s32(a, e, b, c) gen_helper_sub_saturate(a, b, c)
#define gen_helper_neon_qsub_u32(a, e, b, c) gen_helper_sub_usaturate(a, b, c)

#define GEN_NEON_INTEGER_OP_ENV(name) do { \
    switch ((size << 1) | u) { \
    case 0: \
3449
        gen_helper_neon_##name##_s8(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3450 3451
        break; \
    case 1: \
3452
        gen_helper_neon_##name##_u8(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3453 3454
        break; \
    case 2: \
3455
        gen_helper_neon_##name##_s16(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3456 3457
        break; \
    case 3: \
3458
        gen_helper_neon_##name##_u16(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3459 3460
        break; \
    case 4: \
3461
        gen_helper_neon_##name##_s32(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3462 3463
        break; \
    case 5: \
3464
        gen_helper_neon_##name##_u32(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3465 3466 3467
        break; \
    default: return 1; \
    }} while (0)
P
pbrook 已提交
3468 3469 3470

#define GEN_NEON_INTEGER_OP(name) do { \
    switch ((size << 1) | u) { \
P
pbrook 已提交
3471
    case 0: \
3472
        gen_helper_neon_##name##_s8(tmp, tmp, tmp2); \
P
pbrook 已提交
3473 3474
        break; \
    case 1: \
3475
        gen_helper_neon_##name##_u8(tmp, tmp, tmp2); \
P
pbrook 已提交
3476 3477
        break; \
    case 2: \
3478
        gen_helper_neon_##name##_s16(tmp, tmp, tmp2); \
P
pbrook 已提交
3479 3480
        break; \
    case 3: \
3481
        gen_helper_neon_##name##_u16(tmp, tmp, tmp2); \
P
pbrook 已提交
3482 3483
        break; \
    case 4: \
3484
        gen_helper_neon_##name##_s32(tmp, tmp, tmp2); \
P
pbrook 已提交
3485 3486
        break; \
    case 5: \
3487
        gen_helper_neon_##name##_u32(tmp, tmp, tmp2); \
P
pbrook 已提交
3488
        break; \
P
pbrook 已提交
3489 3490 3491
    default: return 1; \
    }} while (0)

3492
static TCGv neon_load_scratch(int scratch)
P
pbrook 已提交
3493
{
3494 3495 3496
    TCGv tmp = new_tmp();
    tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
    return tmp;
P
pbrook 已提交
3497 3498
}

3499
static void neon_store_scratch(int scratch, TCGv var)
P
pbrook 已提交
3500
{
3501 3502
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
    dead_tmp(var);
P
pbrook 已提交
3503 3504
}

3505
static inline TCGv neon_get_scalar(int size, int reg)
P
pbrook 已提交
3506
{
3507
    TCGv tmp;
P
pbrook 已提交
3508
    if (size == 1) {
3509
        tmp = neon_load_reg(reg >> 1, reg & 1);
P
pbrook 已提交
3510
    } else {
3511 3512 3513 3514 3515 3516
        tmp = neon_load_reg(reg >> 2, (reg >> 1) & 1);
        if (reg & 1) {
            gen_neon_dup_low16(tmp);
        } else {
            gen_neon_dup_high16(tmp);
        }
P
pbrook 已提交
3517
    }
3518
    return tmp;
P
pbrook 已提交
3519 3520
}

3521 3522 3523 3524 3525 3526 3527 3528 3529 3530 3531 3532 3533 3534 3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594 3595 3596 3597 3598 3599 3600 3601 3602 3603 3604 3605 3606 3607 3608 3609 3610 3611
static void gen_neon_unzip_u8(TCGv t0, TCGv t1)
{
    TCGv rd, rm, tmp;

    rd = new_tmp();
    rm = new_tmp();
    tmp = new_tmp();

    tcg_gen_andi_i32(rd, t0, 0xff);
    tcg_gen_shri_i32(tmp, t0, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
    tcg_gen_or_i32(rd, rd, tmp);
    tcg_gen_shli_i32(tmp, t1, 16);
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
    tcg_gen_or_i32(rd, rd, tmp);
    tcg_gen_shli_i32(tmp, t1, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff000000);
    tcg_gen_or_i32(rd, rd, tmp);

    tcg_gen_shri_i32(rm, t0, 8);
    tcg_gen_andi_i32(rm, rm, 0xff);
    tcg_gen_shri_i32(tmp, t0, 16);
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
    tcg_gen_or_i32(rm, rm, tmp);
    tcg_gen_shli_i32(tmp, t1, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
    tcg_gen_or_i32(rm, rm, tmp);
    tcg_gen_andi_i32(tmp, t1, 0xff000000);
    tcg_gen_or_i32(t1, rm, tmp);
    tcg_gen_mov_i32(t0, rd);

    dead_tmp(tmp);
    dead_tmp(rm);
    dead_tmp(rd);
}

static void gen_neon_zip_u8(TCGv t0, TCGv t1)
{
    TCGv rd, rm, tmp;

    rd = new_tmp();
    rm = new_tmp();
    tmp = new_tmp();

    tcg_gen_andi_i32(rd, t0, 0xff);
    tcg_gen_shli_i32(tmp, t1, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
    tcg_gen_or_i32(rd, rd, tmp);
    tcg_gen_shli_i32(tmp, t0, 16);
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
    tcg_gen_or_i32(rd, rd, tmp);
    tcg_gen_shli_i32(tmp, t1, 24);
    tcg_gen_andi_i32(tmp, tmp, 0xff000000);
    tcg_gen_or_i32(rd, rd, tmp);

    tcg_gen_andi_i32(rm, t1, 0xff000000);
    tcg_gen_shri_i32(tmp, t0, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
    tcg_gen_or_i32(rm, rm, tmp);
    tcg_gen_shri_i32(tmp, t1, 8);
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
    tcg_gen_or_i32(rm, rm, tmp);
    tcg_gen_shri_i32(tmp, t0, 16);
    tcg_gen_andi_i32(tmp, tmp, 0xff);
    tcg_gen_or_i32(t1, rm, tmp);
    tcg_gen_mov_i32(t0, rd);

    dead_tmp(tmp);
    dead_tmp(rm);
    dead_tmp(rd);
}

static void gen_neon_zip_u16(TCGv t0, TCGv t1)
{
    TCGv tmp, tmp2;

    tmp = new_tmp();
    tmp2 = new_tmp();

    tcg_gen_andi_i32(tmp, t0, 0xffff);
    tcg_gen_shli_i32(tmp2, t1, 16);
    tcg_gen_or_i32(tmp, tmp, tmp2);
    tcg_gen_andi_i32(t1, t1, 0xffff0000);
    tcg_gen_shri_i32(tmp2, t0, 16);
    tcg_gen_or_i32(t1, t1, tmp2);
    tcg_gen_mov_i32(t0, tmp);

    dead_tmp(tmp2);
    dead_tmp(tmp);
}

P
pbrook 已提交
3612 3613 3614
static void gen_neon_unzip(int reg, int q, int tmp, int size)
{
    int n;
3615
    TCGv t0, t1;
P
pbrook 已提交
3616 3617

    for (n = 0; n < q + 1; n += 2) {
3618 3619
        t0 = neon_load_reg(reg, n);
        t1 = neon_load_reg(reg, n + 1);
P
pbrook 已提交
3620
        switch (size) {
3621 3622
        case 0: gen_neon_unzip_u8(t0, t1); break;
        case 1: gen_neon_zip_u16(t0, t1); break; /* zip and unzip are the same.  */
P
pbrook 已提交
3623 3624 3625
        case 2: /* no-op */; break;
        default: abort();
        }
3626 3627
        neon_store_scratch(tmp + n, t0);
        neon_store_scratch(tmp + n + 1, t1);
P
pbrook 已提交
3628 3629 3630
    }
}

3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672
static void gen_neon_trn_u8(TCGv t0, TCGv t1)
{
    TCGv rd, tmp;

    rd = new_tmp();
    tmp = new_tmp();

    tcg_gen_shli_i32(rd, t0, 8);
    tcg_gen_andi_i32(rd, rd, 0xff00ff00);
    tcg_gen_andi_i32(tmp, t1, 0x00ff00ff);
    tcg_gen_or_i32(rd, rd, tmp);

    tcg_gen_shri_i32(t1, t1, 8);
    tcg_gen_andi_i32(t1, t1, 0x00ff00ff);
    tcg_gen_andi_i32(tmp, t0, 0xff00ff00);
    tcg_gen_or_i32(t1, t1, tmp);
    tcg_gen_mov_i32(t0, rd);

    dead_tmp(tmp);
    dead_tmp(rd);
}

static void gen_neon_trn_u16(TCGv t0, TCGv t1)
{
    TCGv rd, tmp;

    rd = new_tmp();
    tmp = new_tmp();

    tcg_gen_shli_i32(rd, t0, 16);
    tcg_gen_andi_i32(tmp, t1, 0xffff);
    tcg_gen_or_i32(rd, rd, tmp);
    tcg_gen_shri_i32(t1, t1, 16);
    tcg_gen_andi_i32(tmp, t0, 0xffff0000);
    tcg_gen_or_i32(t1, t1, tmp);
    tcg_gen_mov_i32(t0, rd);

    dead_tmp(tmp);
    dead_tmp(rd);
}


P
pbrook 已提交
3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705
static struct {
    int nregs;
    int interleave;
    int spacing;
} neon_ls_element_type[11] = {
    {4, 4, 1},
    {4, 4, 2},
    {4, 1, 1},
    {4, 2, 1},
    {3, 3, 1},
    {3, 3, 2},
    {3, 1, 1},
    {1, 1, 1},
    {2, 2, 1},
    {2, 2, 2},
    {2, 1, 1}
};

/* Translate a NEON load/store element instruction.  Return nonzero if the
   instruction is invalid.  */
static int disas_neon_ls_insn(CPUState * env, DisasContext *s, uint32_t insn)
{
    int rd, rn, rm;
    int op;
    int nregs;
    int interleave;
    int stride;
    int size;
    int reg;
    int pass;
    int load;
    int shift;
    int n;
3706
    TCGv addr;
P
pbrook 已提交
3707
    TCGv tmp;
P
pbrook 已提交
3708
    TCGv tmp2;
P
pbrook 已提交
3709 3710 3711 3712 3713 3714 3715

    if (!vfp_enabled(env))
      return 1;
    VFP_DREG_D(rd, insn);
    rn = (insn >> 16) & 0xf;
    rm = insn & 0xf;
    load = (insn & (1 << 21)) != 0;
3716
    addr = new_tmp();
P
pbrook 已提交
3717 3718 3719 3720 3721 3722 3723 3724
    if ((insn & (1 << 23)) == 0) {
        /* Load store all elements.  */
        op = (insn >> 8) & 0xf;
        size = (insn >> 6) & 3;
        if (op > 10 || size == 3)
            return 1;
        nregs = neon_ls_element_type[op].nregs;
        interleave = neon_ls_element_type[op].interleave;
3725
        load_reg_var(s, addr, rn);
P
pbrook 已提交
3726 3727 3728
        stride = (1 << size) * interleave;
        for (reg = 0; reg < nregs; reg++) {
            if (interleave > 2 || (interleave == 2 && nregs == 2)) {
3729 3730
                load_reg_var(s, addr, rn);
                tcg_gen_addi_i32(addr, addr, (1 << size) * reg);
P
pbrook 已提交
3731
            } else if (interleave == 2 && nregs == 4 && reg == 2) {
3732 3733
                load_reg_var(s, addr, rn);
                tcg_gen_addi_i32(addr, addr, 1 << size);
P
pbrook 已提交
3734 3735 3736 3737
            }
            for (pass = 0; pass < 2; pass++) {
                if (size == 2) {
                    if (load) {
3738
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3739
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3740
                    } else {
P
pbrook 已提交
3741
                        tmp = neon_load_reg(rd, pass);
3742
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
3743
                    }
3744
                    tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3745 3746
                } else if (size == 1) {
                    if (load) {
3747 3748 3749 3750
                        tmp = gen_ld16u(addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, stride);
                        tmp2 = gen_ld16u(addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3751 3752 3753
                        gen_bfi(tmp, tmp, tmp2, 16, 0xffff);
                        dead_tmp(tmp2);
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3754
                    } else {
P
pbrook 已提交
3755 3756 3757
                        tmp = neon_load_reg(rd, pass);
                        tmp2 = new_tmp();
                        tcg_gen_shri_i32(tmp2, tmp, 16);
3758 3759 3760 3761
                        gen_st16(tmp, addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, stride);
                        gen_st16(tmp2, addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3762 3763 3764
                    }
                } else /* size == 0 */ {
                    if (load) {
P
pbrook 已提交
3765
                        TCGV_UNUSED(tmp2);
P
pbrook 已提交
3766
                        for (n = 0; n < 4; n++) {
3767 3768
                            tmp = gen_ld8u(addr, IS_USER(s));
                            tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3769
                            if (n == 0) {
P
pbrook 已提交
3770
                                tmp2 = tmp;
P
pbrook 已提交
3771
                            } else {
P
pbrook 已提交
3772 3773
                                gen_bfi(tmp2, tmp2, tmp, n * 8, 0xff);
                                dead_tmp(tmp);
P
pbrook 已提交
3774 3775
                            }
                        }
P
pbrook 已提交
3776
                        neon_store_reg(rd, pass, tmp2);
P
pbrook 已提交
3777
                    } else {
P
pbrook 已提交
3778
                        tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
3779
                        for (n = 0; n < 4; n++) {
P
pbrook 已提交
3780
                            tmp = new_tmp();
P
pbrook 已提交
3781
                            if (n == 0) {
P
pbrook 已提交
3782
                                tcg_gen_mov_i32(tmp, tmp2);
P
pbrook 已提交
3783
                            } else {
P
pbrook 已提交
3784
                                tcg_gen_shri_i32(tmp, tmp2, n * 8);
P
pbrook 已提交
3785
                            }
3786 3787
                            gen_st8(tmp, addr, IS_USER(s));
                            tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3788
                        }
P
pbrook 已提交
3789
                        dead_tmp(tmp2);
P
pbrook 已提交
3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804
                    }
                }
            }
            rd += neon_ls_element_type[op].spacing;
        }
        stride = nregs * 8;
    } else {
        size = (insn >> 10) & 3;
        if (size == 3) {
            /* Load single element to all lanes.  */
            if (!load)
                return 1;
            size = (insn >> 6) & 3;
            nregs = ((insn >> 8) & 3) + 1;
            stride = (insn & (1 << 5)) ? 2 : 1;
3805
            load_reg_var(s, addr, rn);
P
pbrook 已提交
3806 3807 3808
            for (reg = 0; reg < nregs; reg++) {
                switch (size) {
                case 0:
3809
                    tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
3810
                    gen_neon_dup_u8(tmp, 0);
P
pbrook 已提交
3811 3812
                    break;
                case 1:
3813
                    tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
3814
                    gen_neon_dup_low16(tmp);
P
pbrook 已提交
3815 3816
                    break;
                case 2:
3817
                    tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3818 3819 3820
                    break;
                case 3:
                    return 1;
P
pbrook 已提交
3821 3822
                default: /* Avoid compiler warnings.  */
                    abort();
B
bellard 已提交
3823
                }
3824
                tcg_gen_addi_i32(addr, addr, 1 << size);
P
pbrook 已提交
3825 3826 3827
                tmp2 = new_tmp();
                tcg_gen_mov_i32(tmp2, tmp);
                neon_store_reg(rd, 0, tmp2);
P
pbrook 已提交
3828
                neon_store_reg(rd, 1, tmp);
P
pbrook 已提交
3829 3830 3831 3832 3833 3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851
                rd += stride;
            }
            stride = (1 << size) * nregs;
        } else {
            /* Single element.  */
            pass = (insn >> 7) & 1;
            switch (size) {
            case 0:
                shift = ((insn >> 5) & 3) * 8;
                stride = 1;
                break;
            case 1:
                shift = ((insn >> 6) & 1) * 16;
                stride = (insn & (1 << 5)) ? 2 : 1;
                break;
            case 2:
                shift = 0;
                stride = (insn & (1 << 6)) ? 2 : 1;
                break;
            default:
                abort();
            }
            nregs = ((insn >> 8) & 3) + 1;
3852
            load_reg_var(s, addr, rn);
P
pbrook 已提交
3853 3854 3855 3856
            for (reg = 0; reg < nregs; reg++) {
                if (load) {
                    switch (size) {
                    case 0:
3857
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
3858 3859
                        break;
                    case 1:
3860
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
3861 3862
                        break;
                    case 2:
3863
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3864
                        break;
P
pbrook 已提交
3865 3866
                    default: /* Avoid compiler warnings.  */
                        abort();
P
pbrook 已提交
3867 3868
                    }
                    if (size != 2) {
P
pbrook 已提交
3869 3870 3871
                        tmp2 = neon_load_reg(rd, pass);
                        gen_bfi(tmp, tmp2, tmp, shift, size ? 0xffff : 0xff);
                        dead_tmp(tmp2);
P
pbrook 已提交
3872
                    }
P
pbrook 已提交
3873
                    neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3874
                } else { /* Store */
P
pbrook 已提交
3875 3876 3877
                    tmp = neon_load_reg(rd, pass);
                    if (shift)
                        tcg_gen_shri_i32(tmp, tmp, shift);
P
pbrook 已提交
3878 3879
                    switch (size) {
                    case 0:
3880
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
3881 3882
                        break;
                    case 1:
3883
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
3884 3885
                        break;
                    case 2:
3886
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
3887
                        break;
B
bellard 已提交
3888 3889
                    }
                }
P
pbrook 已提交
3890
                rd += stride;
3891
                tcg_gen_addi_i32(addr, addr, 1 << size);
B
bellard 已提交
3892
            }
P
pbrook 已提交
3893
            stride = nregs * (1 << size);
B
bellard 已提交
3894
        }
P
pbrook 已提交
3895
    }
3896
    dead_tmp(addr);
P
pbrook 已提交
3897
    if (rm != 15) {
P
pbrook 已提交
3898 3899 3900
        TCGv base;

        base = load_reg(s, rn);
P
pbrook 已提交
3901
        if (rm == 13) {
P
pbrook 已提交
3902
            tcg_gen_addi_i32(base, base, stride);
P
pbrook 已提交
3903
        } else {
P
pbrook 已提交
3904 3905 3906 3907
            TCGv index;
            index = load_reg(s, rm);
            tcg_gen_add_i32(base, base, index);
            dead_tmp(index);
P
pbrook 已提交
3908
        }
P
pbrook 已提交
3909
        store_reg(s, rn, base);
P
pbrook 已提交
3910 3911 3912
    }
    return 0;
}
3913

P
pbrook 已提交
3914 3915 3916 3917 3918 3919 3920 3921
/* Bitwise select.  dest = c ? t : f.  Clobbers T and F.  */
static void gen_neon_bsl(TCGv dest, TCGv t, TCGv f, TCGv c)
{
    tcg_gen_and_i32(t, t, c);
    tcg_gen_bic_i32(f, f, c);
    tcg_gen_or_i32(dest, t, f);
}

P
pbrook 已提交
3922
static inline void gen_neon_narrow(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3923 3924 3925 3926 3927 3928 3929 3930 3931
{
    switch (size) {
    case 0: gen_helper_neon_narrow_u8(dest, src); break;
    case 1: gen_helper_neon_narrow_u16(dest, src); break;
    case 2: tcg_gen_trunc_i64_i32(dest, src); break;
    default: abort();
    }
}

P
pbrook 已提交
3932
static inline void gen_neon_narrow_sats(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3933 3934 3935 3936 3937 3938 3939 3940 3941
{
    switch (size) {
    case 0: gen_helper_neon_narrow_sat_s8(dest, cpu_env, src); break;
    case 1: gen_helper_neon_narrow_sat_s16(dest, cpu_env, src); break;
    case 2: gen_helper_neon_narrow_sat_s32(dest, cpu_env, src); break;
    default: abort();
    }
}

P
pbrook 已提交
3942
static inline void gen_neon_narrow_satu(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985
{
    switch (size) {
    case 0: gen_helper_neon_narrow_sat_u8(dest, cpu_env, src); break;
    case 1: gen_helper_neon_narrow_sat_u16(dest, cpu_env, src); break;
    case 2: gen_helper_neon_narrow_sat_u32(dest, cpu_env, src); break;
    default: abort();
    }
}

static inline void gen_neon_shift_narrow(int size, TCGv var, TCGv shift,
                                         int q, int u)
{
    if (q) {
        if (u) {
            switch (size) {
            case 1: gen_helper_neon_rshl_u16(var, var, shift); break;
            case 2: gen_helper_neon_rshl_u32(var, var, shift); break;
            default: abort();
            }
        } else {
            switch (size) {
            case 1: gen_helper_neon_rshl_s16(var, var, shift); break;
            case 2: gen_helper_neon_rshl_s32(var, var, shift); break;
            default: abort();
            }
        }
    } else {
        if (u) {
            switch (size) {
            case 1: gen_helper_neon_rshl_u16(var, var, shift); break;
            case 2: gen_helper_neon_rshl_u32(var, var, shift); break;
            default: abort();
            }
        } else {
            switch (size) {
            case 1: gen_helper_neon_shl_s16(var, var, shift); break;
            case 2: gen_helper_neon_shl_s32(var, var, shift); break;
            default: abort();
            }
        }
    }
}

P
pbrook 已提交
3986
static inline void gen_neon_widen(TCGv_i64 dest, TCGv src, int size, int u)
P
pbrook 已提交
3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023 4024 4025
{
    if (u) {
        switch (size) {
        case 0: gen_helper_neon_widen_u8(dest, src); break;
        case 1: gen_helper_neon_widen_u16(dest, src); break;
        case 2: tcg_gen_extu_i32_i64(dest, src); break;
        default: abort();
        }
    } else {
        switch (size) {
        case 0: gen_helper_neon_widen_s8(dest, src); break;
        case 1: gen_helper_neon_widen_s16(dest, src); break;
        case 2: tcg_gen_ext_i32_i64(dest, src); break;
        default: abort();
        }
    }
    dead_tmp(src);
}

static inline void gen_neon_addl(int size)
{
    switch (size) {
    case 0: gen_helper_neon_addl_u16(CPU_V001); break;
    case 1: gen_helper_neon_addl_u32(CPU_V001); break;
    case 2: tcg_gen_add_i64(CPU_V001); break;
    default: abort();
    }
}

static inline void gen_neon_subl(int size)
{
    switch (size) {
    case 0: gen_helper_neon_subl_u16(CPU_V001); break;
    case 1: gen_helper_neon_subl_u32(CPU_V001); break;
    case 2: tcg_gen_sub_i64(CPU_V001); break;
    default: abort();
    }
}

P
pbrook 已提交
4026
static inline void gen_neon_negl(TCGv_i64 var, int size)
P
pbrook 已提交
4027 4028 4029 4030 4031 4032 4033 4034 4035
{
    switch (size) {
    case 0: gen_helper_neon_negl_u16(var, var); break;
    case 1: gen_helper_neon_negl_u32(var, var); break;
    case 2: gen_helper_neon_negl_u64(var, var); break;
    default: abort();
    }
}

P
pbrook 已提交
4036
static inline void gen_neon_addl_saturate(TCGv_i64 op0, TCGv_i64 op1, int size)
P
pbrook 已提交
4037 4038 4039 4040 4041 4042 4043 4044
{
    switch (size) {
    case 1: gen_helper_neon_addl_saturate_s32(op0, cpu_env, op0, op1); break;
    case 2: gen_helper_neon_addl_saturate_s64(op0, cpu_env, op0, op1); break;
    default: abort();
    }
}

P
pbrook 已提交
4045
static inline void gen_neon_mull(TCGv_i64 dest, TCGv a, TCGv b, int size, int u)
P
pbrook 已提交
4046
{
P
pbrook 已提交
4047
    TCGv_i64 tmp;
P
pbrook 已提交
4048 4049 4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064 4065

    switch ((size << 1) | u) {
    case 0: gen_helper_neon_mull_s8(dest, a, b); break;
    case 1: gen_helper_neon_mull_u8(dest, a, b); break;
    case 2: gen_helper_neon_mull_s16(dest, a, b); break;
    case 3: gen_helper_neon_mull_u16(dest, a, b); break;
    case 4:
        tmp = gen_muls_i64_i32(a, b);
        tcg_gen_mov_i64(dest, tmp);
        break;
    case 5:
        tmp = gen_mulu_i64_i32(a, b);
        tcg_gen_mov_i64(dest, tmp);
        break;
    default: abort();
    }
}

P
pbrook 已提交
4066 4067
/* Translate a NEON data processing instruction.  Return nonzero if the
   instruction is invalid.
P
pbrook 已提交
4068 4069
   We process data in a mixture of 32-bit and 64-bit chunks.
   Mostly we use 32-bit chunks so we can use normal scalar instructions.  */
B
bellard 已提交
4070

P
pbrook 已提交
4071 4072 4073 4074 4075 4076 4077 4078 4079 4080 4081 4082 4083
static int disas_neon_data_insn(CPUState * env, DisasContext *s, uint32_t insn)
{
    int op;
    int q;
    int rd, rn, rm;
    int size;
    int shift;
    int pass;
    int count;
    int pairwise;
    int u;
    int n;
    uint32_t imm;
4084
    TCGv tmp, tmp2, tmp3, tmp4, tmp5;
P
pbrook 已提交
4085
    TCGv_i64 tmp64;
P
pbrook 已提交
4086 4087 4088 4089 4090 4091 4092 4093 4094 4095 4096 4097

    if (!vfp_enabled(env))
      return 1;
    q = (insn & (1 << 6)) != 0;
    u = (insn >> 24) & 1;
    VFP_DREG_D(rd, insn);
    VFP_DREG_N(rn, insn);
    VFP_DREG_M(rm, insn);
    size = (insn >> 20) & 3;
    if ((insn & (1 << 23)) == 0) {
        /* Three register same length.  */
        op = ((insn >> 7) & 0x1e) | ((insn >> 4) & 1);
P
pbrook 已提交
4098 4099 4100
        if (size == 3 && (op == 1 || op == 5 || op == 8 || op == 9
                          || op == 10 || op  == 11 || op == 16)) {
            /* 64-bit element instructions.  */
P
pbrook 已提交
4101
            for (pass = 0; pass < (q ? 2 : 1); pass++) {
P
pbrook 已提交
4102 4103
                neon_load_reg64(cpu_V0, rn + pass);
                neon_load_reg64(cpu_V1, rm + pass);
P
pbrook 已提交
4104 4105 4106
                switch (op) {
                case 1: /* VQADD */
                    if (u) {
P
pbrook 已提交
4107
                        gen_helper_neon_add_saturate_u64(CPU_V001);
B
bellard 已提交
4108
                    } else {
P
pbrook 已提交
4109
                        gen_helper_neon_add_saturate_s64(CPU_V001);
B
bellard 已提交
4110
                    }
P
pbrook 已提交
4111 4112 4113
                    break;
                case 5: /* VQSUB */
                    if (u) {
P
pbrook 已提交
4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130 4131 4132 4133 4134 4135 4136 4137
                        gen_helper_neon_sub_saturate_u64(CPU_V001);
                    } else {
                        gen_helper_neon_sub_saturate_s64(CPU_V001);
                    }
                    break;
                case 8: /* VSHL */
                    if (u) {
                        gen_helper_neon_shl_u64(cpu_V0, cpu_V1, cpu_V0);
                    } else {
                        gen_helper_neon_shl_s64(cpu_V0, cpu_V1, cpu_V0);
                    }
                    break;
                case 9: /* VQSHL */
                    if (u) {
                        gen_helper_neon_qshl_u64(cpu_V0, cpu_env,
                                                 cpu_V0, cpu_V0);
                    } else {
                        gen_helper_neon_qshl_s64(cpu_V1, cpu_env,
                                                 cpu_V1, cpu_V0);
                    }
                    break;
                case 10: /* VRSHL */
                    if (u) {
                        gen_helper_neon_rshl_u64(cpu_V0, cpu_V1, cpu_V0);
B
bellard 已提交
4138
                    } else {
P
pbrook 已提交
4139 4140 4141 4142 4143 4144 4145 4146 4147 4148
                        gen_helper_neon_rshl_s64(cpu_V0, cpu_V1, cpu_V0);
                    }
                    break;
                case 11: /* VQRSHL */
                    if (u) {
                        gen_helper_neon_qrshl_u64(cpu_V0, cpu_env,
                                                  cpu_V1, cpu_V0);
                    } else {
                        gen_helper_neon_qrshl_s64(cpu_V0, cpu_env,
                                                  cpu_V1, cpu_V0);
B
bellard 已提交
4149
                    }
P
pbrook 已提交
4150 4151 4152
                    break;
                case 16:
                    if (u) {
P
pbrook 已提交
4153
                        tcg_gen_sub_i64(CPU_V001);
P
pbrook 已提交
4154
                    } else {
P
pbrook 已提交
4155
                        tcg_gen_add_i64(CPU_V001);
P
pbrook 已提交
4156 4157 4158 4159
                    }
                    break;
                default:
                    abort();
B
bellard 已提交
4160
                }
P
pbrook 已提交
4161
                neon_store_reg64(cpu_V0, rd + pass);
B
bellard 已提交
4162
            }
P
pbrook 已提交
4163
            return 0;
B
bellard 已提交
4164
        }
P
pbrook 已提交
4165 4166 4167 4168
        switch (op) {
        case 8: /* VSHL */
        case 9: /* VQSHL */
        case 10: /* VRSHL */
P
pbrook 已提交
4169
        case 11: /* VQRSHL */
P
pbrook 已提交
4170
            {
P
pbrook 已提交
4171 4172 4173
                int rtmp;
                /* Shift instruction operands are reversed.  */
                rtmp = rn;
P
pbrook 已提交
4174
                rn = rm;
P
pbrook 已提交
4175
                rm = rtmp;
P
pbrook 已提交
4176 4177
                pairwise = 0;
            }
B
bellard 已提交
4178
            break;
P
pbrook 已提交
4179 4180 4181 4182
        case 20: /* VPMAX */
        case 21: /* VPMIN */
        case 23: /* VPADD */
            pairwise = 1;
B
bellard 已提交
4183
            break;
P
pbrook 已提交
4184 4185
        case 26: /* VPADD (float) */
            pairwise = (u && size < 2);
B
bellard 已提交
4186
            break;
P
pbrook 已提交
4187 4188
        case 30: /* VPMIN/VPMAX (float) */
            pairwise = u;
B
bellard 已提交
4189
            break;
P
pbrook 已提交
4190 4191
        default:
            pairwise = 0;
B
bellard 已提交
4192
            break;
P
pbrook 已提交
4193
        }
4194

P
pbrook 已提交
4195 4196 4197 4198 4199 4200
        for (pass = 0; pass < (q ? 4 : 2); pass++) {

        if (pairwise) {
            /* Pairwise.  */
            if (q)
                n = (pass & 1) * 2;
B
bellard 已提交
4201
            else
P
pbrook 已提交
4202 4203
                n = 0;
            if (pass < q + 1) {
4204 4205
                tmp = neon_load_reg(rn, n);
                tmp2 = neon_load_reg(rn, n + 1);
P
pbrook 已提交
4206
            } else {
4207 4208
                tmp = neon_load_reg(rm, n);
                tmp2 = neon_load_reg(rm, n + 1);
P
pbrook 已提交
4209 4210 4211
            }
        } else {
            /* Elementwise.  */
4212 4213
            tmp = neon_load_reg(rn, pass);
            tmp2 = neon_load_reg(rm, pass);
P
pbrook 已提交
4214 4215 4216 4217 4218 4219
        }
        switch (op) {
        case 0: /* VHADD */
            GEN_NEON_INTEGER_OP(hadd);
            break;
        case 1: /* VQADD */
P
pbrook 已提交
4220
            GEN_NEON_INTEGER_OP_ENV(qadd);
B
bellard 已提交
4221
            break;
P
pbrook 已提交
4222 4223
        case 2: /* VRHADD */
            GEN_NEON_INTEGER_OP(rhadd);
B
bellard 已提交
4224
            break;
P
pbrook 已提交
4225 4226 4227
        case 3: /* Logic ops.  */
            switch ((u << 2) | size) {
            case 0: /* VAND */
4228
                tcg_gen_and_i32(tmp, tmp, tmp2);
P
pbrook 已提交
4229 4230
                break;
            case 1: /* BIC */
4231
                tcg_gen_bic_i32(tmp, tmp, tmp2);
P
pbrook 已提交
4232 4233
                break;
            case 2: /* VORR */
4234
                tcg_gen_or_i32(tmp, tmp, tmp2);
P
pbrook 已提交
4235 4236
                break;
            case 3: /* VORN */
4237 4238
                tcg_gen_not_i32(tmp2, tmp2);
                tcg_gen_or_i32(tmp, tmp, tmp2);
P
pbrook 已提交
4239 4240
                break;
            case 4: /* VEOR */
4241
                tcg_gen_xor_i32(tmp, tmp, tmp2);
P
pbrook 已提交
4242 4243
                break;
            case 5: /* VBSL */
4244 4245 4246
                tmp3 = neon_load_reg(rd, pass);
                gen_neon_bsl(tmp, tmp, tmp2, tmp3);
                dead_tmp(tmp3);
P
pbrook 已提交
4247 4248
                break;
            case 6: /* VBIT */
4249 4250 4251
                tmp3 = neon_load_reg(rd, pass);
                gen_neon_bsl(tmp, tmp, tmp3, tmp2);
                dead_tmp(tmp3);
P
pbrook 已提交
4252 4253
                break;
            case 7: /* VBIF */
4254 4255 4256
                tmp3 = neon_load_reg(rd, pass);
                gen_neon_bsl(tmp, tmp3, tmp, tmp2);
                dead_tmp(tmp3);
P
pbrook 已提交
4257
                break;
B
bellard 已提交
4258 4259
            }
            break;
P
pbrook 已提交
4260 4261 4262 4263
        case 4: /* VHSUB */
            GEN_NEON_INTEGER_OP(hsub);
            break;
        case 5: /* VQSUB */
P
pbrook 已提交
4264
            GEN_NEON_INTEGER_OP_ENV(qsub);
B
bellard 已提交
4265
            break;
P
pbrook 已提交
4266 4267 4268 4269 4270 4271 4272
        case 6: /* VCGT */
            GEN_NEON_INTEGER_OP(cgt);
            break;
        case 7: /* VCGE */
            GEN_NEON_INTEGER_OP(cge);
            break;
        case 8: /* VSHL */
P
pbrook 已提交
4273
            GEN_NEON_INTEGER_OP(shl);
B
bellard 已提交
4274
            break;
P
pbrook 已提交
4275
        case 9: /* VQSHL */
P
pbrook 已提交
4276
            GEN_NEON_INTEGER_OP_ENV(qshl);
B
bellard 已提交
4277
            break;
P
pbrook 已提交
4278
        case 10: /* VRSHL */
P
pbrook 已提交
4279
            GEN_NEON_INTEGER_OP(rshl);
B
bellard 已提交
4280
            break;
P
pbrook 已提交
4281
        case 11: /* VQRSHL */
P
pbrook 已提交
4282
            GEN_NEON_INTEGER_OP_ENV(qrshl);
P
pbrook 已提交
4283 4284 4285 4286 4287 4288 4289 4290 4291 4292 4293 4294
            break;
        case 12: /* VMAX */
            GEN_NEON_INTEGER_OP(max);
            break;
        case 13: /* VMIN */
            GEN_NEON_INTEGER_OP(min);
            break;
        case 14: /* VABD */
            GEN_NEON_INTEGER_OP(abd);
            break;
        case 15: /* VABA */
            GEN_NEON_INTEGER_OP(abd);
4295 4296 4297
            dead_tmp(tmp2);
            tmp2 = neon_load_reg(rd, pass);
            gen_neon_add(size, tmp, tmp2);
P
pbrook 已提交
4298 4299 4300
            break;
        case 16:
            if (!u) { /* VADD */
4301
                if (gen_neon_add(size, tmp, tmp2))
P
pbrook 已提交
4302 4303 4304
                    return 1;
            } else { /* VSUB */
                switch (size) {
4305 4306 4307
                case 0: gen_helper_neon_sub_u8(tmp, tmp, tmp2); break;
                case 1: gen_helper_neon_sub_u16(tmp, tmp, tmp2); break;
                case 2: tcg_gen_sub_i32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4308 4309 4310 4311 4312 4313 4314
                default: return 1;
                }
            }
            break;
        case 17:
            if (!u) { /* VTST */
                switch (size) {
4315 4316 4317
                case 0: gen_helper_neon_tst_u8(tmp, tmp, tmp2); break;
                case 1: gen_helper_neon_tst_u16(tmp, tmp, tmp2); break;
                case 2: gen_helper_neon_tst_u32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4318 4319 4320 4321
                default: return 1;
                }
            } else { /* VCEQ */
                switch (size) {
4322 4323 4324
                case 0: gen_helper_neon_ceq_u8(tmp, tmp, tmp2); break;
                case 1: gen_helper_neon_ceq_u16(tmp, tmp, tmp2); break;
                case 2: gen_helper_neon_ceq_u32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4325 4326 4327 4328 4329 4330
                default: return 1;
                }
            }
            break;
        case 18: /* Multiply.  */
            switch (size) {
4331 4332 4333
            case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
            case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
            case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4334 4335
            default: return 1;
            }
4336 4337
            dead_tmp(tmp2);
            tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
4338
            if (u) { /* VMLS */
4339
                gen_neon_rsb(size, tmp, tmp2);
P
pbrook 已提交
4340
            } else { /* VMLA */
4341
                gen_neon_add(size, tmp, tmp2);
P
pbrook 已提交
4342 4343 4344 4345
            }
            break;
        case 19: /* VMUL */
            if (u) { /* polynomial */
4346
                gen_helper_neon_mul_p8(tmp, tmp, tmp2);
P
pbrook 已提交
4347 4348
            } else { /* Integer */
                switch (size) {
4349 4350 4351
                case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
                case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
                case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364
                default: return 1;
                }
            }
            break;
        case 20: /* VPMAX */
            GEN_NEON_INTEGER_OP(pmax);
            break;
        case 21: /* VPMIN */
            GEN_NEON_INTEGER_OP(pmin);
            break;
        case 22: /* Hultiply high.  */
            if (!u) { /* VQDMULH */
                switch (size) {
4365 4366
                case 1: gen_helper_neon_qdmulh_s16(tmp, cpu_env, tmp, tmp2); break;
                case 2: gen_helper_neon_qdmulh_s32(tmp, cpu_env, tmp, tmp2); break;
P
pbrook 已提交
4367 4368 4369 4370
                default: return 1;
                }
            } else { /* VQRDHMUL */
                switch (size) {
4371 4372
                case 1: gen_helper_neon_qrdmulh_s16(tmp, cpu_env, tmp, tmp2); break;
                case 2: gen_helper_neon_qrdmulh_s32(tmp, cpu_env, tmp, tmp2); break;
P
pbrook 已提交
4373 4374 4375 4376 4377 4378 4379 4380
                default: return 1;
                }
            }
            break;
        case 23: /* VPADD */
            if (u)
                return 1;
            switch (size) {
4381 4382 4383
            case 0: gen_helper_neon_padd_u8(tmp, tmp, tmp2); break;
            case 1: gen_helper_neon_padd_u16(tmp, tmp, tmp2); break;
            case 2: tcg_gen_add_i32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4384 4385 4386 4387 4388 4389
            default: return 1;
            }
            break;
        case 26: /* Floating point arithnetic.  */
            switch ((u << 2) | size) {
            case 0: /* VADD */
4390
                gen_helper_neon_add_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4391 4392
                break;
            case 2: /* VSUB */
4393
                gen_helper_neon_sub_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4394 4395
                break;
            case 4: /* VPADD */
4396
                gen_helper_neon_add_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4397 4398
                break;
            case 6: /* VABD */
4399
                gen_helper_neon_abd_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4400 4401 4402 4403 4404 4405
                break;
            default:
                return 1;
            }
            break;
        case 27: /* Float multiply.  */
4406
            gen_helper_neon_mul_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4407
            if (!u) {
4408 4409
                dead_tmp(tmp2);
                tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
4410
                if (size == 0) {
4411
                    gen_helper_neon_add_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4412
                } else {
4413
                    gen_helper_neon_sub_f32(tmp, tmp2, tmp);
P
pbrook 已提交
4414 4415 4416 4417 4418
                }
            }
            break;
        case 28: /* Float compare.  */
            if (!u) {
4419
                gen_helper_neon_ceq_f32(tmp, tmp, tmp2);
B
bellard 已提交
4420
            } else {
P
pbrook 已提交
4421
                if (size == 0)
4422
                    gen_helper_neon_cge_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4423
                else
4424
                    gen_helper_neon_cgt_f32(tmp, tmp, tmp2);
B
bellard 已提交
4425
            }
B
bellard 已提交
4426
            break;
P
pbrook 已提交
4427 4428 4429 4430
        case 29: /* Float compare absolute.  */
            if (!u)
                return 1;
            if (size == 0)
4431
                gen_helper_neon_acge_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4432
            else
4433
                gen_helper_neon_acgt_f32(tmp, tmp, tmp2);
B
bellard 已提交
4434
            break;
P
pbrook 已提交
4435 4436
        case 30: /* Float min/max.  */
            if (size == 0)
4437
                gen_helper_neon_max_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4438
            else
4439
                gen_helper_neon_min_f32(tmp, tmp, tmp2);
P
pbrook 已提交
4440 4441 4442
            break;
        case 31:
            if (size == 0)
4443
                gen_helper_recps_f32(tmp, tmp, tmp2, cpu_env);
P
pbrook 已提交
4444
            else
4445
                gen_helper_rsqrts_f32(tmp, tmp, tmp2, cpu_env);
B
bellard 已提交
4446
            break;
P
pbrook 已提交
4447 4448
        default:
            abort();
B
bellard 已提交
4449
        }
4450 4451
        dead_tmp(tmp2);

P
pbrook 已提交
4452 4453 4454 4455
        /* Save the result.  For elementwise operations we can put it
           straight into the destination register.  For pairwise operations
           we have to be careful to avoid clobbering the source operands.  */
        if (pairwise && rd == rm) {
4456
            neon_store_scratch(pass, tmp);
P
pbrook 已提交
4457
        } else {
4458
            neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4459 4460 4461 4462 4463
        }

        } /* for pass */
        if (pairwise && rd == rm) {
            for (pass = 0; pass < (q ? 4 : 2); pass++) {
4464 4465
                tmp = neon_load_scratch(pass);
                neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4466 4467
            }
        }
P
pbrook 已提交
4468
        /* End of 3 register same size operations.  */
P
pbrook 已提交
4469 4470 4471 4472 4473 4474 4475 4476 4477 4478 4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489 4490 4491 4492 4493 4494 4495 4496 4497 4498 4499 4500 4501 4502 4503 4504 4505 4506 4507 4508 4509 4510 4511 4512 4513 4514
    } else if (insn & (1 << 4)) {
        if ((insn & 0x00380080) != 0) {
            /* Two registers and shift.  */
            op = (insn >> 8) & 0xf;
            if (insn & (1 << 7)) {
                /* 64-bit shift.   */
                size = 3;
            } else {
                size = 2;
                while ((insn & (1 << (size + 19))) == 0)
                    size--;
            }
            shift = (insn >> 16) & ((1 << (3 + size)) - 1);
            /* To avoid excessive dumplication of ops we implement shift
               by immediate using the variable shift operations.  */
            if (op < 8) {
                /* Shift by immediate:
                   VSHR, VSRA, VRSHR, VRSRA, VSRI, VSHL, VQSHL, VQSHLU.  */
                /* Right shifts are encoded as N - shift, where N is the
                   element size in bits.  */
                if (op <= 4)
                    shift = shift - (1 << (size + 3));
                if (size == 3) {
                    count = q + 1;
                } else {
                    count = q ? 4: 2;
                }
                switch (size) {
                case 0:
                    imm = (uint8_t) shift;
                    imm |= imm << 8;
                    imm |= imm << 16;
                    break;
                case 1:
                    imm = (uint16_t) shift;
                    imm |= imm << 16;
                    break;
                case 2:
                case 3:
                    imm = shift;
                    break;
                default:
                    abort();
                }

                for (pass = 0; pass < count; pass++) {
P
pbrook 已提交
4515 4516 4517 4518 4519 4520 4521 4522
                    if (size == 3) {
                        neon_load_reg64(cpu_V0, rm + pass);
                        tcg_gen_movi_i64(cpu_V1, imm);
                        switch (op) {
                        case 0:  /* VSHR */
                        case 1:  /* VSRA */
                            if (u)
                                gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4523
                            else
P
pbrook 已提交
4524
                                gen_helper_neon_shl_s64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4525
                            break;
P
pbrook 已提交
4526 4527 4528 4529
                        case 2: /* VRSHR */
                        case 3: /* VRSRA */
                            if (u)
                                gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4530
                            else
P
pbrook 已提交
4531
                                gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4532
                            break;
P
pbrook 已提交
4533 4534 4535 4536 4537 4538 4539 4540 4541 4542 4543
                        case 4: /* VSRI */
                            if (!u)
                                return 1;
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
                            break;
                        case 5: /* VSHL, VSLI */
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
                            break;
                        case 6: /* VQSHL */
                            if (u)
                                gen_helper_neon_qshl_u64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
P
pbrook 已提交
4544
                            else
P
pbrook 已提交
4545 4546 4547 4548
                                gen_helper_neon_qshl_s64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
                            break;
                        case 7: /* VQSHLU */
                            gen_helper_neon_qshl_u64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
P
pbrook 已提交
4549 4550
                            break;
                        }
P
pbrook 已提交
4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561
                        if (op == 1 || op == 3) {
                            /* Accumulate.  */
                            neon_load_reg64(cpu_V0, rd + pass);
                            tcg_gen_add_i64(cpu_V0, cpu_V0, cpu_V1);
                        } else if (op == 4 || (op == 5 && u)) {
                            /* Insert */
                            cpu_abort(env, "VS[LR]I.64 not implemented");
                        }
                        neon_store_reg64(cpu_V0, rd + pass);
                    } else { /* size < 3 */
                        /* Operands in T0 and T1.  */
4562 4563 4564
                        tmp = neon_load_reg(rm, pass);
                        tmp2 = new_tmp();
                        tcg_gen_movi_i32(tmp2, imm);
P
pbrook 已提交
4565 4566 4567 4568 4569 4570 4571 4572 4573 4574 4575 4576 4577 4578 4579 4580
                        switch (op) {
                        case 0:  /* VSHR */
                        case 1:  /* VSRA */
                            GEN_NEON_INTEGER_OP(shl);
                            break;
                        case 2: /* VRSHR */
                        case 3: /* VRSRA */
                            GEN_NEON_INTEGER_OP(rshl);
                            break;
                        case 4: /* VSRI */
                            if (!u)
                                return 1;
                            GEN_NEON_INTEGER_OP(shl);
                            break;
                        case 5: /* VSHL, VSLI */
                            switch (size) {
4581 4582 4583
                            case 0: gen_helper_neon_shl_u8(tmp, tmp, tmp2); break;
                            case 1: gen_helper_neon_shl_u16(tmp, tmp, tmp2); break;
                            case 2: gen_helper_neon_shl_u32(tmp, tmp, tmp2); break;
P
pbrook 已提交
4584 4585 4586 4587 4588 4589 4590 4591
                            default: return 1;
                            }
                            break;
                        case 6: /* VQSHL */
                            GEN_NEON_INTEGER_OP_ENV(qshl);
                            break;
                        case 7: /* VQSHLU */
                            switch (size) {
4592 4593 4594
                            case 0: gen_helper_neon_qshl_u8(tmp, cpu_env, tmp, tmp2); break;
                            case 1: gen_helper_neon_qshl_u16(tmp, cpu_env, tmp, tmp2); break;
                            case 2: gen_helper_neon_qshl_u32(tmp, cpu_env, tmp, tmp2); break;
P
pbrook 已提交
4595 4596 4597 4598
                            default: return 1;
                            }
                            break;
                        }
4599
                        dead_tmp(tmp2);
P
pbrook 已提交
4600 4601 4602

                        if (op == 1 || op == 3) {
                            /* Accumulate.  */
4603 4604 4605
                            tmp2 = neon_load_reg(rd, pass);
                            gen_neon_add(size, tmp2, tmp);
                            dead_tmp(tmp2);
P
pbrook 已提交
4606 4607 4608 4609 4610 4611 4612 4613 4614 4615 4616 4617 4618 4619 4620 4621 4622 4623 4624 4625 4626 4627 4628 4629 4630 4631 4632
                        } else if (op == 4 || (op == 5 && u)) {
                            /* Insert */
                            switch (size) {
                            case 0:
                                if (op == 4)
                                    imm = 0xff >> -shift;
                                else
                                    imm = (uint8_t)(0xff << shift);
                                imm |= imm << 8;
                                imm |= imm << 16;
                                break;
                            case 1:
                                if (op == 4)
                                    imm = 0xffff >> -shift;
                                else
                                    imm = (uint16_t)(0xffff << shift);
                                imm |= imm << 16;
                                break;
                            case 2:
                                if (op == 4)
                                    imm = 0xffffffffu >> -shift;
                                else
                                    imm = 0xffffffffu << shift;
                                break;
                            default:
                                abort();
                            }
4633 4634 4635 4636 4637
                            tmp2 = neon_load_reg(rd, pass);
                            tcg_gen_andi_i32(tmp, tmp, imm);
                            tcg_gen_andi_i32(tmp2, tmp2, ~imm);
                            tcg_gen_or_i32(tmp, tmp, tmp2);
                            dead_tmp(tmp2);
P
pbrook 已提交
4638
                        }
4639
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4640 4641 4642
                    }
                } /* for pass */
            } else if (op < 10) {
P
pbrook 已提交
4643
                /* Shift by immediate and narrow:
P
pbrook 已提交
4644 4645 4646 4647 4648
                   VSHRN, VRSHRN, VQSHRN, VQRSHRN.  */
                shift = shift - (1 << (size + 3));
                size++;
                switch (size) {
                case 1:
P
pbrook 已提交
4649
                    imm = (uint16_t)shift;
P
pbrook 已提交
4650
                    imm |= imm << 16;
P
pbrook 已提交
4651
                    tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
4652
                    TCGV_UNUSED_I64(tmp64);
P
pbrook 已提交
4653 4654
                    break;
                case 2:
P
pbrook 已提交
4655 4656
                    imm = (uint32_t)shift;
                    tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
4657
                    TCGV_UNUSED_I64(tmp64);
4658
                    break;
P
pbrook 已提交
4659
                case 3:
P
pbrook 已提交
4660 4661
                    tmp64 = tcg_const_i64(shift);
                    TCGV_UNUSED(tmp2);
P
pbrook 已提交
4662 4663 4664 4665 4666
                    break;
                default:
                    abort();
                }

P
pbrook 已提交
4667 4668 4669 4670 4671
                for (pass = 0; pass < 2; pass++) {
                    if (size == 3) {
                        neon_load_reg64(cpu_V0, rm + pass);
                        if (q) {
                          if (u)
P
pbrook 已提交
4672
                            gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4673
                          else
P
pbrook 已提交
4674
                            gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4675 4676
                        } else {
                          if (u)
P
pbrook 已提交
4677
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4678
                          else
P
pbrook 已提交
4679
                            gen_helper_neon_shl_s64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4680
                        }
B
bellard 已提交
4681
                    } else {
P
pbrook 已提交
4682 4683
                        tmp = neon_load_reg(rm + pass, 0);
                        gen_neon_shift_narrow(size, tmp, tmp2, q, u);
P
pbrook 已提交
4684 4685 4686
                        tmp3 = neon_load_reg(rm + pass, 1);
                        gen_neon_shift_narrow(size, tmp3, tmp2, q, u);
                        tcg_gen_concat_i32_i64(cpu_V0, tmp, tmp3);
P
pbrook 已提交
4687
                        dead_tmp(tmp);
P
pbrook 已提交
4688
                        dead_tmp(tmp3);
P
pbrook 已提交
4689
                    }
P
pbrook 已提交
4690 4691 4692
                    tmp = new_tmp();
                    if (op == 8 && !u) {
                        gen_neon_narrow(size - 1, tmp, cpu_V0);
P
pbrook 已提交
4693
                    } else {
P
pbrook 已提交
4694 4695
                        if (op == 8)
                            gen_neon_narrow_sats(size - 1, tmp, cpu_V0);
P
pbrook 已提交
4696
                        else
P
pbrook 已提交
4697 4698 4699
                            gen_neon_narrow_satu(size - 1, tmp, cpu_V0);
                    }
                    if (pass == 0) {
4700 4701 4702
                        if (size != 3) {
                            dead_tmp(tmp2);
                        }
P
pbrook 已提交
4703 4704 4705 4706
                        tmp2 = tmp;
                    } else {
                        neon_store_reg(rd, 0, tmp2);
                        neon_store_reg(rd, 1, tmp);
P
pbrook 已提交
4707 4708
                    }
                } /* for pass */
4709 4710 4711
                if (size == 3) {
                    tcg_temp_free_i64(tmp64);
                }
P
pbrook 已提交
4712 4713
            } else if (op == 10) {
                /* VSHLL */
P
pbrook 已提交
4714
                if (q || size == 3)
P
pbrook 已提交
4715
                    return 1;
P
pbrook 已提交
4716 4717
                tmp = neon_load_reg(rm, 0);
                tmp2 = neon_load_reg(rm, 1);
P
pbrook 已提交
4718
                for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
4719 4720 4721 4722
                    if (pass == 1)
                        tmp = tmp2;

                    gen_neon_widen(cpu_V0, tmp, size, u);
P
pbrook 已提交
4723 4724 4725

                    if (shift != 0) {
                        /* The shift is less than the width of the source
P
pbrook 已提交
4726 4727 4728 4729 4730 4731 4732 4733 4734
                           type, so we can just shift the whole register.  */
                        tcg_gen_shli_i64(cpu_V0, cpu_V0, shift);
                        if (size < 2 || !u) {
                            uint64_t imm64;
                            if (size == 0) {
                                imm = (0xffu >> (8 - shift));
                                imm |= imm << 16;
                            } else {
                                imm = 0xffff >> (16 - shift);
P
pbrook 已提交
4735
                            }
P
pbrook 已提交
4736 4737
                            imm64 = imm | (((uint64_t)imm) << 32);
                            tcg_gen_andi_i64(cpu_V0, cpu_V0, imm64);
P
pbrook 已提交
4738 4739
                        }
                    }
P
pbrook 已提交
4740
                    neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
4741 4742 4743 4744
                }
            } else if (op == 15 || op == 16) {
                /* VCVT fixed-point.  */
                for (pass = 0; pass < (q ? 4 : 2); pass++) {
P
pbrook 已提交
4745
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, pass));
P
pbrook 已提交
4746 4747
                    if (op & 1) {
                        if (u)
P
pbrook 已提交
4748
                            gen_vfp_ulto(0, shift);
P
pbrook 已提交
4749
                        else
P
pbrook 已提交
4750
                            gen_vfp_slto(0, shift);
P
pbrook 已提交
4751 4752
                    } else {
                        if (u)
P
pbrook 已提交
4753
                            gen_vfp_toul(0, shift);
P
pbrook 已提交
4754
                        else
P
pbrook 已提交
4755
                            gen_vfp_tosl(0, shift);
B
bellard 已提交
4756
                    }
P
pbrook 已提交
4757
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, pass));
B
bellard 已提交
4758 4759
                }
            } else {
P
pbrook 已提交
4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772 4773 4774 4775 4776 4777 4778 4779 4780 4781 4782 4783 4784 4785 4786 4787 4788 4789 4790 4791 4792 4793 4794 4795 4796 4797 4798 4799 4800 4801 4802 4803 4804 4805 4806 4807 4808
                return 1;
            }
        } else { /* (insn & 0x00380080) == 0 */
            int invert;

            op = (insn >> 8) & 0xf;
            /* One register and immediate.  */
            imm = (u << 7) | ((insn >> 12) & 0x70) | (insn & 0xf);
            invert = (insn & (1 << 5)) != 0;
            switch (op) {
            case 0: case 1:
                /* no-op */
                break;
            case 2: case 3:
                imm <<= 8;
                break;
            case 4: case 5:
                imm <<= 16;
                break;
            case 6: case 7:
                imm <<= 24;
                break;
            case 8: case 9:
                imm |= imm << 16;
                break;
            case 10: case 11:
                imm = (imm << 8) | (imm << 24);
                break;
            case 12:
                imm = (imm < 8) | 0xff;
                break;
            case 13:
                imm = (imm << 16) | 0xffff;
                break;
            case 14:
                imm |= (imm << 8) | (imm << 16) | (imm << 24);
                if (invert)
                    imm = ~imm;
                break;
            case 15:
                imm = ((imm & 0x80) << 24) | ((imm & 0x3f) << 19)
                      | ((imm & 0x40) ? (0x1f << 25) : (1 << 30));
                break;
            }
            if (invert)
                imm = ~imm;

            for (pass = 0; pass < (q ? 4 : 2); pass++) {
                if (op & 1 && op < 12) {
P
pbrook 已提交
4809
                    tmp = neon_load_reg(rd, pass);
P
pbrook 已提交
4810 4811 4812
                    if (invert) {
                        /* The immediate value has already been inverted, so
                           BIC becomes AND.  */
P
pbrook 已提交
4813
                        tcg_gen_andi_i32(tmp, tmp, imm);
P
pbrook 已提交
4814
                    } else {
P
pbrook 已提交
4815
                        tcg_gen_ori_i32(tmp, tmp, imm);
P
pbrook 已提交
4816 4817
                    }
                } else {
P
pbrook 已提交
4818 4819
                    /* VMOV, VMVN.  */
                    tmp = new_tmp();
P
pbrook 已提交
4820
                    if (op == 14 && invert) {
P
pbrook 已提交
4821 4822
                        uint32_t val;
                        val = 0;
P
pbrook 已提交
4823 4824
                        for (n = 0; n < 4; n++) {
                            if (imm & (1 << (n + (pass & 1) * 4)))
P
pbrook 已提交
4825
                                val |= 0xff << (n * 8);
P
pbrook 已提交
4826
                        }
P
pbrook 已提交
4827 4828 4829
                        tcg_gen_movi_i32(tmp, val);
                    } else {
                        tcg_gen_movi_i32(tmp, imm);
P
pbrook 已提交
4830 4831
                    }
                }
P
pbrook 已提交
4832
                neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4833 4834
            }
        }
P
pbrook 已提交
4835
    } else { /* (insn & 0x00800010 == 0x00800000) */
P
pbrook 已提交
4836 4837 4838 4839 4840 4841 4842 4843 4844 4845 4846 4847 4848 4849 4850 4851 4852 4853 4854 4855 4856 4857 4858 4859 4860 4861 4862 4863 4864 4865
        if (size != 3) {
            op = (insn >> 8) & 0xf;
            if ((insn & (1 << 6)) == 0) {
                /* Three registers of different lengths.  */
                int src1_wide;
                int src2_wide;
                int prewiden;
                /* prewiden, src1_wide, src2_wide */
                static const int neon_3reg_wide[16][3] = {
                    {1, 0, 0}, /* VADDL */
                    {1, 1, 0}, /* VADDW */
                    {1, 0, 0}, /* VSUBL */
                    {1, 1, 0}, /* VSUBW */
                    {0, 1, 1}, /* VADDHN */
                    {0, 0, 0}, /* VABAL */
                    {0, 1, 1}, /* VSUBHN */
                    {0, 0, 0}, /* VABDL */
                    {0, 0, 0}, /* VMLAL */
                    {0, 0, 0}, /* VQDMLAL */
                    {0, 0, 0}, /* VMLSL */
                    {0, 0, 0}, /* VQDMLSL */
                    {0, 0, 0}, /* Integer VMULL */
                    {0, 0, 0}, /* VQDMULL */
                    {0, 0, 0}  /* Polynomial VMULL */
                };

                prewiden = neon_3reg_wide[op][0];
                src1_wide = neon_3reg_wide[op][1];
                src2_wide = neon_3reg_wide[op][2];

P
pbrook 已提交
4866 4867 4868
                if (size == 0 && (op == 9 || op == 11 || op == 13))
                    return 1;

P
pbrook 已提交
4869 4870 4871
                /* Avoid overlapping operands.  Wide source operands are
                   always aligned so will never overlap with wide
                   destinations in problematic ways.  */
P
pbrook 已提交
4872
                if (rd == rm && !src2_wide) {
4873 4874
                    tmp = neon_load_reg(rm, 1);
                    neon_store_scratch(2, tmp);
P
pbrook 已提交
4875
                } else if (rd == rn && !src1_wide) {
4876 4877
                    tmp = neon_load_reg(rn, 1);
                    neon_store_scratch(2, tmp);
P
pbrook 已提交
4878
                }
P
pbrook 已提交
4879
                TCGV_UNUSED(tmp3);
P
pbrook 已提交
4880
                for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
4881 4882
                    if (src1_wide) {
                        neon_load_reg64(cpu_V0, rn + pass);
P
pbrook 已提交
4883
                        TCGV_UNUSED(tmp);
P
pbrook 已提交
4884
                    } else {
P
pbrook 已提交
4885
                        if (pass == 1 && rd == rn) {
4886
                            tmp = neon_load_scratch(2);
P
pbrook 已提交
4887
                        } else {
P
pbrook 已提交
4888 4889 4890 4891
                            tmp = neon_load_reg(rn, pass);
                        }
                        if (prewiden) {
                            gen_neon_widen(cpu_V0, tmp, size, u);
P
pbrook 已提交
4892 4893
                        }
                    }
P
pbrook 已提交
4894 4895
                    if (src2_wide) {
                        neon_load_reg64(cpu_V1, rm + pass);
P
pbrook 已提交
4896
                        TCGV_UNUSED(tmp2);
P
pbrook 已提交
4897
                    } else {
P
pbrook 已提交
4898
                        if (pass == 1 && rd == rm) {
4899
                            tmp2 = neon_load_scratch(2);
P
pbrook 已提交
4900
                        } else {
P
pbrook 已提交
4901 4902 4903 4904
                            tmp2 = neon_load_reg(rm, pass);
                        }
                        if (prewiden) {
                            gen_neon_widen(cpu_V1, tmp2, size, u);
P
pbrook 已提交
4905 4906 4907 4908
                        }
                    }
                    switch (op) {
                    case 0: case 1: case 4: /* VADDL, VADDW, VADDHN, VRADDHN */
P
pbrook 已提交
4909
                        gen_neon_addl(size);
P
pbrook 已提交
4910 4911
                        break;
                    case 2: case 3: case 6: /* VSUBL, VSUBW, VSUBHL, VRSUBHL */
P
pbrook 已提交
4912
                        gen_neon_subl(size);
P
pbrook 已提交
4913 4914 4915
                        break;
                    case 5: case 7: /* VABAL, VABDL */
                        switch ((size << 1) | u) {
P
pbrook 已提交
4916 4917 4918 4919 4920 4921 4922 4923 4924 4925 4926 4927 4928 4929 4930 4931 4932 4933
                        case 0:
                            gen_helper_neon_abdl_s16(cpu_V0, tmp, tmp2);
                            break;
                        case 1:
                            gen_helper_neon_abdl_u16(cpu_V0, tmp, tmp2);
                            break;
                        case 2:
                            gen_helper_neon_abdl_s32(cpu_V0, tmp, tmp2);
                            break;
                        case 3:
                            gen_helper_neon_abdl_u32(cpu_V0, tmp, tmp2);
                            break;
                        case 4:
                            gen_helper_neon_abdl_s64(cpu_V0, tmp, tmp2);
                            break;
                        case 5:
                            gen_helper_neon_abdl_u64(cpu_V0, tmp, tmp2);
                            break;
P
pbrook 已提交
4934 4935
                        default: abort();
                        }
P
pbrook 已提交
4936 4937
                        dead_tmp(tmp2);
                        dead_tmp(tmp);
P
pbrook 已提交
4938 4939 4940
                        break;
                    case 8: case 9: case 10: case 11: case 12: case 13:
                        /* VMLAL, VQDMLAL, VMLSL, VQDMLSL, VMULL, VQDMULL */
P
pbrook 已提交
4941
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
4942 4943
                        dead_tmp(tmp2);
                        dead_tmp(tmp);
P
pbrook 已提交
4944 4945 4946 4947 4948 4949 4950 4951 4952 4953
                        break;
                    case 14: /* Polynomial VMULL */
                        cpu_abort(env, "Polynomial VMULL not implemented");

                    default: /* 15 is RESERVED.  */
                        return 1;
                    }
                    if (op == 5 || op == 13 || (op >= 8 && op <= 11)) {
                        /* Accumulate.  */
                        if (op == 10 || op == 11) {
P
pbrook 已提交
4954
                            gen_neon_negl(cpu_V0, size);
P
pbrook 已提交
4955 4956 4957
                        }

                        if (op != 13) {
P
pbrook 已提交
4958
                            neon_load_reg64(cpu_V1, rd + pass);
P
pbrook 已提交
4959 4960 4961 4962
                        }

                        switch (op) {
                        case 5: case 8: case 10: /* VABAL, VMLAL, VMLSL */
P
pbrook 已提交
4963
                            gen_neon_addl(size);
P
pbrook 已提交
4964 4965
                            break;
                        case 9: case 11: /* VQDMLAL, VQDMLSL */
P
pbrook 已提交
4966 4967 4968
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
                            break;
P
pbrook 已提交
4969 4970
                            /* Fall through.  */
                        case 13: /* VQDMULL */
P
pbrook 已提交
4971
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
P
pbrook 已提交
4972 4973 4974 4975
                            break;
                        default:
                            abort();
                        }
P
pbrook 已提交
4976
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
4977 4978
                    } else if (op == 4 || op == 6) {
                        /* Narrowing operation.  */
P
pbrook 已提交
4979
                        tmp = new_tmp();
P
pbrook 已提交
4980 4981
                        if (u) {
                            switch (size) {
P
pbrook 已提交
4982 4983 4984 4985 4986 4987 4988 4989 4990 4991
                            case 0:
                                gen_helper_neon_narrow_high_u8(tmp, cpu_V0);
                                break;
                            case 1:
                                gen_helper_neon_narrow_high_u16(tmp, cpu_V0);
                                break;
                            case 2:
                                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
                                tcg_gen_trunc_i64_i32(tmp, cpu_V0);
                                break;
P
pbrook 已提交
4992 4993 4994 4995
                            default: abort();
                            }
                        } else {
                            switch (size) {
P
pbrook 已提交
4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006
                            case 0:
                                gen_helper_neon_narrow_round_high_u8(tmp, cpu_V0);
                                break;
                            case 1:
                                gen_helper_neon_narrow_round_high_u16(tmp, cpu_V0);
                                break;
                            case 2:
                                tcg_gen_addi_i64(cpu_V0, cpu_V0, 1u << 31);
                                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
                                tcg_gen_trunc_i64_i32(tmp, cpu_V0);
                                break;
P
pbrook 已提交
5007 5008 5009
                            default: abort();
                            }
                        }
P
pbrook 已提交
5010 5011 5012 5013 5014 5015
                        if (pass == 0) {
                            tmp3 = tmp;
                        } else {
                            neon_store_reg(rd, 0, tmp3);
                            neon_store_reg(rd, 1, tmp);
                        }
P
pbrook 已提交
5016 5017
                    } else {
                        /* Write back the result.  */
P
pbrook 已提交
5018
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
5019 5020 5021 5022 5023 5024 5025 5026 5027 5028 5029 5030 5031
                    }
                }
            } else {
                /* Two registers and a scalar.  */
                switch (op) {
                case 0: /* Integer VMLA scalar */
                case 1: /* Float VMLA scalar */
                case 4: /* Integer VMLS scalar */
                case 5: /* Floating point VMLS scalar */
                case 8: /* Integer VMUL scalar */
                case 9: /* Floating point VMUL scalar */
                case 12: /* VQDMULH scalar */
                case 13: /* VQRDMULH scalar */
5032 5033
                    tmp = neon_get_scalar(size, rm);
                    neon_store_scratch(0, tmp);
P
pbrook 已提交
5034
                    for (pass = 0; pass < (u ? 4 : 2); pass++) {
5035 5036
                        tmp = neon_load_scratch(0);
                        tmp2 = neon_load_reg(rn, pass);
P
pbrook 已提交
5037 5038
                        if (op == 12) {
                            if (size == 1) {
5039
                                gen_helper_neon_qdmulh_s16(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5040
                            } else {
5041
                                gen_helper_neon_qdmulh_s32(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5042 5043 5044
                            }
                        } else if (op == 13) {
                            if (size == 1) {
5045
                                gen_helper_neon_qrdmulh_s16(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5046
                            } else {
5047
                                gen_helper_neon_qrdmulh_s32(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5048 5049
                            }
                        } else if (op & 1) {
5050
                            gen_helper_neon_mul_f32(tmp, tmp, tmp2);
P
pbrook 已提交
5051 5052
                        } else {
                            switch (size) {
5053 5054 5055
                            case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
                            case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
                            case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
P
pbrook 已提交
5056 5057 5058
                            default: return 1;
                            }
                        }
5059
                        dead_tmp(tmp2);
P
pbrook 已提交
5060 5061
                        if (op < 8) {
                            /* Accumulate.  */
5062
                            tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
5063 5064
                            switch (op) {
                            case 0:
5065
                                gen_neon_add(size, tmp, tmp2);
P
pbrook 已提交
5066 5067
                                break;
                            case 1:
5068
                                gen_helper_neon_add_f32(tmp, tmp, tmp2);
P
pbrook 已提交
5069 5070
                                break;
                            case 4:
5071
                                gen_neon_rsb(size, tmp, tmp2);
P
pbrook 已提交
5072 5073
                                break;
                            case 5:
5074
                                gen_helper_neon_sub_f32(tmp, tmp2, tmp);
P
pbrook 已提交
5075 5076 5077 5078
                                break;
                            default:
                                abort();
                            }
5079
                            dead_tmp(tmp2);
P
pbrook 已提交
5080
                        }
5081
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
5082 5083 5084 5085 5086 5087 5088 5089
                    }
                    break;
                case 2: /* VMLAL sclar */
                case 3: /* VQDMLAL scalar */
                case 6: /* VMLSL scalar */
                case 7: /* VQDMLSL scalar */
                case 10: /* VMULL scalar */
                case 11: /* VQDMULL scalar */
P
pbrook 已提交
5090 5091 5092
                    if (size == 0 && (op == 3 || op == 7 || op == 11))
                        return 1;

5093 5094
                    tmp2 = neon_get_scalar(size, rm);
                    tmp3 = neon_load_reg(rn, 1);
P
pbrook 已提交
5095

P
pbrook 已提交
5096
                    for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
5097 5098
                        if (pass == 0) {
                            tmp = neon_load_reg(rn, 0);
P
pbrook 已提交
5099
                        } else {
5100
                            tmp = tmp3;
P
pbrook 已提交
5101
                        }
P
pbrook 已提交
5102
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
5103
                        dead_tmp(tmp);
P
pbrook 已提交
5104
                        if (op == 6 || op == 7) {
P
pbrook 已提交
5105 5106 5107 5108
                            gen_neon_negl(cpu_V0, size);
                        }
                        if (op != 11) {
                            neon_load_reg64(cpu_V1, rd + pass);
P
pbrook 已提交
5109 5110 5111
                        }
                        switch (op) {
                        case 2: case 6:
P
pbrook 已提交
5112
                            gen_neon_addl(size);
P
pbrook 已提交
5113 5114
                            break;
                        case 3: case 7:
P
pbrook 已提交
5115 5116
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
P
pbrook 已提交
5117 5118 5119 5120 5121
                            break;
                        case 10:
                            /* no-op */
                            break;
                        case 11:
P
pbrook 已提交
5122
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
P
pbrook 已提交
5123 5124 5125 5126
                            break;
                        default:
                            abort();
                        }
P
pbrook 已提交
5127
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
5128
                    }
5129 5130 5131

                    dead_tmp(tmp2);

P
pbrook 已提交
5132 5133 5134 5135 5136 5137 5138 5139 5140
                    break;
                default: /* 14 and 15 are RESERVED */
                    return 1;
                }
            }
        } else { /* size == 3 */
            if (!u) {
                /* Extract.  */
                imm = (insn >> 8) & 0xf;
P
pbrook 已提交
5141 5142 5143 5144 5145 5146 5147 5148 5149
                count = q + 1;

                if (imm > 7 && !q)
                    return 1;

                if (imm == 0) {
                    neon_load_reg64(cpu_V0, rn);
                    if (q) {
                        neon_load_reg64(cpu_V1, rn + 1);
P
pbrook 已提交
5150
                    }
P
pbrook 已提交
5151 5152 5153 5154
                } else if (imm == 8) {
                    neon_load_reg64(cpu_V0, rn + 1);
                    if (q) {
                        neon_load_reg64(cpu_V1, rm);
P
pbrook 已提交
5155
                    }
P
pbrook 已提交
5156
                } else if (q) {
P
pbrook 已提交
5157
                    tmp64 = tcg_temp_new_i64();
P
pbrook 已提交
5158 5159
                    if (imm < 8) {
                        neon_load_reg64(cpu_V0, rn);
P
pbrook 已提交
5160
                        neon_load_reg64(tmp64, rn + 1);
P
pbrook 已提交
5161 5162
                    } else {
                        neon_load_reg64(cpu_V0, rn + 1);
P
pbrook 已提交
5163
                        neon_load_reg64(tmp64, rm);
P
pbrook 已提交
5164 5165
                    }
                    tcg_gen_shri_i64(cpu_V0, cpu_V0, (imm & 7) * 8);
P
pbrook 已提交
5166
                    tcg_gen_shli_i64(cpu_V1, tmp64, 64 - ((imm & 7) * 8));
P
pbrook 已提交
5167 5168 5169
                    tcg_gen_or_i64(cpu_V0, cpu_V0, cpu_V1);
                    if (imm < 8) {
                        neon_load_reg64(cpu_V1, rm);
P
pbrook 已提交
5170
                    } else {
P
pbrook 已提交
5171 5172
                        neon_load_reg64(cpu_V1, rm + 1);
                        imm -= 8;
P
pbrook 已提交
5173
                    }
P
pbrook 已提交
5174
                    tcg_gen_shli_i64(cpu_V1, cpu_V1, 64 - (imm * 8));
P
pbrook 已提交
5175 5176
                    tcg_gen_shri_i64(tmp64, tmp64, imm * 8);
                    tcg_gen_or_i64(cpu_V1, cpu_V1, tmp64);
5177
                    tcg_temp_free_i64(tmp64);
P
pbrook 已提交
5178
                } else {
P
pbrook 已提交
5179
                    /* BUGFIX */
P
pbrook 已提交
5180
                    neon_load_reg64(cpu_V0, rn);
P
pbrook 已提交
5181
                    tcg_gen_shri_i64(cpu_V0, cpu_V0, imm * 8);
P
pbrook 已提交
5182
                    neon_load_reg64(cpu_V1, rm);
P
pbrook 已提交
5183
                    tcg_gen_shli_i64(cpu_V1, cpu_V1, 64 - (imm * 8));
P
pbrook 已提交
5184 5185 5186 5187 5188
                    tcg_gen_or_i64(cpu_V0, cpu_V0, cpu_V1);
                }
                neon_store_reg64(cpu_V0, rd);
                if (q) {
                    neon_store_reg64(cpu_V1, rd + 1);
P
pbrook 已提交
5189 5190 5191 5192 5193 5194 5195 5196 5197 5198
                }
            } else if ((insn & (1 << 11)) == 0) {
                /* Two register misc.  */
                op = ((insn >> 12) & 0x30) | ((insn >> 7) & 0xf);
                size = (insn >> 18) & 3;
                switch (op) {
                case 0: /* VREV64 */
                    if (size == 3)
                        return 1;
                    for (pass = 0; pass < (q ? 2 : 1); pass++) {
5199 5200
                        tmp = neon_load_reg(rm, pass * 2);
                        tmp2 = neon_load_reg(rm, pass * 2 + 1);
P
pbrook 已提交
5201
                        switch (size) {
5202 5203
                        case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
                        case 1: gen_swap_half(tmp); break;
P
pbrook 已提交
5204 5205 5206
                        case 2: /* no-op */ break;
                        default: abort();
                        }
5207
                        neon_store_reg(rd, pass * 2 + 1, tmp);
P
pbrook 已提交
5208
                        if (size == 2) {
5209
                            neon_store_reg(rd, pass * 2, tmp2);
P
pbrook 已提交
5210 5211
                        } else {
                            switch (size) {
5212 5213
                            case 0: tcg_gen_bswap32_i32(tmp2, tmp2); break;
                            case 1: gen_swap_half(tmp2); break;
P
pbrook 已提交
5214 5215
                            default: abort();
                            }
5216
                            neon_store_reg(rd, pass * 2, tmp2);
P
pbrook 已提交
5217 5218 5219 5220 5221 5222 5223
                        }
                    }
                    break;
                case 4: case 5: /* VPADDL */
                case 12: case 13: /* VPADAL */
                    if (size == 3)
                        return 1;
P
pbrook 已提交
5224 5225 5226 5227 5228 5229 5230 5231 5232 5233 5234
                    for (pass = 0; pass < q + 1; pass++) {
                        tmp = neon_load_reg(rm, pass * 2);
                        gen_neon_widen(cpu_V0, tmp, size, op & 1);
                        tmp = neon_load_reg(rm, pass * 2 + 1);
                        gen_neon_widen(cpu_V1, tmp, size, op & 1);
                        switch (size) {
                        case 0: gen_helper_neon_paddl_u16(CPU_V001); break;
                        case 1: gen_helper_neon_paddl_u32(CPU_V001); break;
                        case 2: tcg_gen_add_i64(CPU_V001); break;
                        default: abort();
                        }
P
pbrook 已提交
5235 5236
                        if (op >= 12) {
                            /* Accumulate.  */
P
pbrook 已提交
5237 5238
                            neon_load_reg64(cpu_V1, rd + pass);
                            gen_neon_addl(size);
P
pbrook 已提交
5239
                        }
P
pbrook 已提交
5240
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
5241 5242 5243 5244 5245
                    }
                    break;
                case 33: /* VTRN */
                    if (size == 2) {
                        for (n = 0; n < (q ? 4 : 2); n += 2) {
5246 5247 5248 5249
                            tmp = neon_load_reg(rm, n);
                            tmp2 = neon_load_reg(rd, n + 1);
                            neon_store_reg(rm, n, tmp2);
                            neon_store_reg(rd, n + 1, tmp);
P
pbrook 已提交
5250 5251 5252 5253 5254 5255 5256 5257 5258 5259 5260 5261 5262 5263 5264 5265 5266 5267 5268
                        }
                    } else {
                        goto elementwise;
                    }
                    break;
                case 34: /* VUZP */
                    /* Reg  Before       After
                       Rd   A3 A2 A1 A0  B2 B0 A2 A0
                       Rm   B3 B2 B1 B0  B3 B1 A3 A1
                     */
                    if (size == 3)
                        return 1;
                    gen_neon_unzip(rd, q, 0, size);
                    gen_neon_unzip(rm, q, 4, size);
                    if (q) {
                        static int unzip_order_q[8] =
                            {0, 2, 4, 6, 1, 3, 5, 7};
                        for (n = 0; n < 8; n++) {
                            int reg = (n < 4) ? rd : rm;
5269 5270
                            tmp = neon_load_scratch(unzip_order_q[n]);
                            neon_store_reg(reg, n % 4, tmp);
P
pbrook 已提交
5271 5272 5273 5274 5275 5276
                        }
                    } else {
                        static int unzip_order[4] =
                            {0, 4, 1, 5};
                        for (n = 0; n < 4; n++) {
                            int reg = (n < 2) ? rd : rm;
5277 5278
                            tmp = neon_load_scratch(unzip_order[n]);
                            neon_store_reg(reg, n % 2, tmp);
P
pbrook 已提交
5279 5280 5281 5282 5283 5284 5285 5286 5287 5288 5289 5290
                        }
                    }
                    break;
                case 35: /* VZIP */
                    /* Reg  Before       After
                       Rd   A3 A2 A1 A0  B1 A1 B0 A0
                       Rm   B3 B2 B1 B0  B3 A3 B2 A2
                     */
                    if (size == 3)
                        return 1;
                    count = (q ? 4 : 2);
                    for (n = 0; n < count; n++) {
5291 5292
                        tmp = neon_load_reg(rd, n);
                        tmp2 = neon_load_reg(rd, n);
P
pbrook 已提交
5293
                        switch (size) {
5294 5295
                        case 0: gen_neon_zip_u8(tmp, tmp2); break;
                        case 1: gen_neon_zip_u16(tmp, tmp2); break;
P
pbrook 已提交
5296 5297 5298
                        case 2: /* no-op */; break;
                        default: abort();
                        }
5299 5300
                        neon_store_scratch(n * 2, tmp);
                        neon_store_scratch(n * 2 + 1, tmp2);
P
pbrook 已提交
5301 5302 5303
                    }
                    for (n = 0; n < count * 2; n++) {
                        int reg = (n < count) ? rd : rm;
5304 5305
                        tmp = neon_load_scratch(n);
                        neon_store_reg(reg, n % count, tmp);
P
pbrook 已提交
5306 5307 5308
                    }
                    break;
                case 36: case 37: /* VMOVN, VQMOVUN, VQMOVN */
P
pbrook 已提交
5309 5310
                    if (size == 3)
                        return 1;
P
pbrook 已提交
5311
                    TCGV_UNUSED(tmp2);
P
pbrook 已提交
5312
                    for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
5313 5314
                        neon_load_reg64(cpu_V0, rm + pass);
                        tmp = new_tmp();
P
pbrook 已提交
5315
                        if (op == 36 && q == 0) {
P
pbrook 已提交
5316
                            gen_neon_narrow(size, tmp, cpu_V0);
P
pbrook 已提交
5317
                        } else if (q) {
P
pbrook 已提交
5318
                            gen_neon_narrow_satu(size, tmp, cpu_V0);
P
pbrook 已提交
5319
                        } else {
P
pbrook 已提交
5320 5321 5322 5323 5324 5325 5326
                            gen_neon_narrow_sats(size, tmp, cpu_V0);
                        }
                        if (pass == 0) {
                            tmp2 = tmp;
                        } else {
                            neon_store_reg(rd, 0, tmp2);
                            neon_store_reg(rd, 1, tmp);
P
pbrook 已提交
5327 5328 5329 5330
                        }
                    }
                    break;
                case 38: /* VSHLL */
P
pbrook 已提交
5331
                    if (q || size == 3)
P
pbrook 已提交
5332
                        return 1;
P
pbrook 已提交
5333 5334
                    tmp = neon_load_reg(rm, 0);
                    tmp2 = neon_load_reg(rm, 1);
P
pbrook 已提交
5335
                    for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
5336 5337 5338 5339
                        if (pass == 1)
                            tmp = tmp2;
                        gen_neon_widen(cpu_V0, tmp, size, 1);
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
5340 5341 5342 5343 5344 5345
                    }
                    break;
                default:
                elementwise:
                    for (pass = 0; pass < (q ? 4 : 2); pass++) {
                        if (op == 30 || op == 31 || op >= 58) {
P
pbrook 已提交
5346 5347
                            tcg_gen_ld_f32(cpu_F0s, cpu_env,
                                           neon_reg_offset(rm, pass));
5348
                            TCGV_UNUSED(tmp);
P
pbrook 已提交
5349
                        } else {
5350
                            tmp = neon_load_reg(rm, pass);
P
pbrook 已提交
5351 5352 5353 5354
                        }
                        switch (op) {
                        case 1: /* VREV32 */
                            switch (size) {
5355 5356
                            case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
                            case 1: gen_swap_half(tmp); break;
P
pbrook 已提交
5357 5358 5359 5360 5361 5362
                            default: return 1;
                            }
                            break;
                        case 2: /* VREV16 */
                            if (size != 0)
                                return 1;
5363
                            gen_rev16(tmp);
P
pbrook 已提交
5364 5365 5366
                            break;
                        case 8: /* CLS */
                            switch (size) {
5367 5368 5369
                            case 0: gen_helper_neon_cls_s8(tmp, tmp); break;
                            case 1: gen_helper_neon_cls_s16(tmp, tmp); break;
                            case 2: gen_helper_neon_cls_s32(tmp, tmp); break;
P
pbrook 已提交
5370 5371 5372 5373 5374
                            default: return 1;
                            }
                            break;
                        case 9: /* CLZ */
                            switch (size) {
5375 5376 5377
                            case 0: gen_helper_neon_clz_u8(tmp, tmp); break;
                            case 1: gen_helper_neon_clz_u16(tmp, tmp); break;
                            case 2: gen_helper_clz(tmp, tmp); break;
P
pbrook 已提交
5378 5379 5380 5381 5382 5383
                            default: return 1;
                            }
                            break;
                        case 10: /* CNT */
                            if (size != 0)
                                return 1;
5384
                            gen_helper_neon_cnt_u8(tmp, tmp);
P
pbrook 已提交
5385 5386 5387 5388
                            break;
                        case 11: /* VNOT */
                            if (size != 0)
                                return 1;
5389
                            tcg_gen_not_i32(tmp, tmp);
P
pbrook 已提交
5390 5391 5392
                            break;
                        case 14: /* VQABS */
                            switch (size) {
5393 5394 5395
                            case 0: gen_helper_neon_qabs_s8(tmp, cpu_env, tmp); break;
                            case 1: gen_helper_neon_qabs_s16(tmp, cpu_env, tmp); break;
                            case 2: gen_helper_neon_qabs_s32(tmp, cpu_env, tmp); break;
P
pbrook 已提交
5396 5397 5398 5399 5400
                            default: return 1;
                            }
                            break;
                        case 15: /* VQNEG */
                            switch (size) {
5401 5402 5403
                            case 0: gen_helper_neon_qneg_s8(tmp, cpu_env, tmp); break;
                            case 1: gen_helper_neon_qneg_s16(tmp, cpu_env, tmp); break;
                            case 2: gen_helper_neon_qneg_s32(tmp, cpu_env, tmp); break;
P
pbrook 已提交
5404 5405 5406 5407
                            default: return 1;
                            }
                            break;
                        case 16: case 19: /* VCGT #0, VCLE #0 */
5408
                            tmp2 = tcg_const_i32(0);
P
pbrook 已提交
5409
                            switch(size) {
5410 5411 5412
                            case 0: gen_helper_neon_cgt_s8(tmp, tmp, tmp2); break;
                            case 1: gen_helper_neon_cgt_s16(tmp, tmp, tmp2); break;
                            case 2: gen_helper_neon_cgt_s32(tmp, tmp, tmp2); break;
P
pbrook 已提交
5413 5414
                            default: return 1;
                            }
5415
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5416
                            if (op == 19)
5417
                                tcg_gen_not_i32(tmp, tmp);
P
pbrook 已提交
5418 5419
                            break;
                        case 17: case 20: /* VCGE #0, VCLT #0 */
5420
                            tmp2 = tcg_const_i32(0);
P
pbrook 已提交
5421
                            switch(size) {
5422 5423 5424
                            case 0: gen_helper_neon_cge_s8(tmp, tmp, tmp2); break;
                            case 1: gen_helper_neon_cge_s16(tmp, tmp, tmp2); break;
                            case 2: gen_helper_neon_cge_s32(tmp, tmp, tmp2); break;
P
pbrook 已提交
5425 5426
                            default: return 1;
                            }
5427
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5428
                            if (op == 20)
5429
                                tcg_gen_not_i32(tmp, tmp);
P
pbrook 已提交
5430 5431
                            break;
                        case 18: /* VCEQ #0 */
5432
                            tmp2 = tcg_const_i32(0);
P
pbrook 已提交
5433
                            switch(size) {
5434 5435 5436
                            case 0: gen_helper_neon_ceq_u8(tmp, tmp, tmp2); break;
                            case 1: gen_helper_neon_ceq_u16(tmp, tmp, tmp2); break;
                            case 2: gen_helper_neon_ceq_u32(tmp, tmp, tmp2); break;
P
pbrook 已提交
5437 5438
                            default: return 1;
                            }
5439
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5440 5441 5442
                            break;
                        case 22: /* VABS */
                            switch(size) {
5443 5444 5445
                            case 0: gen_helper_neon_abs_s8(tmp, tmp); break;
                            case 1: gen_helper_neon_abs_s16(tmp, tmp); break;
                            case 2: tcg_gen_abs_i32(tmp, tmp); break;
P
pbrook 已提交
5446 5447 5448 5449
                            default: return 1;
                            }
                            break;
                        case 23: /* VNEG */
P
pbrook 已提交
5450 5451
                            if (size == 3)
                                return 1;
5452 5453 5454
                            tmp2 = tcg_const_i32(0);
                            gen_neon_rsb(size, tmp, tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5455 5456
                            break;
                        case 24: case 27: /* Float VCGT #0, Float VCLE #0 */
5457 5458 5459
                            tmp2 = tcg_const_i32(0);
                            gen_helper_neon_cgt_f32(tmp, tmp, tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5460
                            if (op == 27)
5461
                                tcg_gen_not_i32(tmp, tmp);
P
pbrook 已提交
5462 5463
                            break;
                        case 25: case 28: /* Float VCGE #0, Float VCLT #0 */
5464 5465 5466
                            tmp2 = tcg_const_i32(0);
                            gen_helper_neon_cge_f32(tmp, tmp, tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5467
                            if (op == 28)
5468
                                tcg_gen_not_i32(tmp, tmp);
P
pbrook 已提交
5469 5470
                            break;
                        case 26: /* Float VCEQ #0 */
5471 5472 5473
                            tmp2 = tcg_const_i32(0);
                            gen_helper_neon_ceq_f32(tmp, tmp, tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
5474 5475
                            break;
                        case 30: /* Float VABS */
P
pbrook 已提交
5476
                            gen_vfp_abs(0);
P
pbrook 已提交
5477 5478
                            break;
                        case 31: /* Float VNEG */
P
pbrook 已提交
5479
                            gen_vfp_neg(0);
P
pbrook 已提交
5480 5481
                            break;
                        case 32: /* VSWP */
5482 5483
                            tmp2 = neon_load_reg(rd, pass);
                            neon_store_reg(rm, pass, tmp2);
P
pbrook 已提交
5484 5485
                            break;
                        case 33: /* VTRN */
5486
                            tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
5487
                            switch (size) {
5488 5489
                            case 0: gen_neon_trn_u8(tmp, tmp2); break;
                            case 1: gen_neon_trn_u16(tmp, tmp2); break;
P
pbrook 已提交
5490 5491 5492
                            case 2: abort();
                            default: return 1;
                            }
5493
                            neon_store_reg(rm, pass, tmp2);
P
pbrook 已提交
5494 5495
                            break;
                        case 56: /* Integer VRECPE */
5496
                            gen_helper_recpe_u32(tmp, tmp, cpu_env);
P
pbrook 已提交
5497 5498
                            break;
                        case 57: /* Integer VRSQRTE */
5499
                            gen_helper_rsqrte_u32(tmp, tmp, cpu_env);
P
pbrook 已提交
5500 5501
                            break;
                        case 58: /* Float VRECPE */
P
pbrook 已提交
5502
                            gen_helper_recpe_f32(cpu_F0s, cpu_F0s, cpu_env);
P
pbrook 已提交
5503 5504
                            break;
                        case 59: /* Float VRSQRTE */
P
pbrook 已提交
5505
                            gen_helper_rsqrte_f32(cpu_F0s, cpu_F0s, cpu_env);
P
pbrook 已提交
5506 5507
                            break;
                        case 60: /* VCVT.F32.S32 */
P
pbrook 已提交
5508
                            gen_vfp_tosiz(0);
P
pbrook 已提交
5509 5510
                            break;
                        case 61: /* VCVT.F32.U32 */
P
pbrook 已提交
5511
                            gen_vfp_touiz(0);
P
pbrook 已提交
5512 5513
                            break;
                        case 62: /* VCVT.S32.F32 */
P
pbrook 已提交
5514
                            gen_vfp_sito(0);
P
pbrook 已提交
5515 5516
                            break;
                        case 63: /* VCVT.U32.F32 */
P
pbrook 已提交
5517
                            gen_vfp_uito(0);
P
pbrook 已提交
5518 5519 5520 5521 5522 5523
                            break;
                        default:
                            /* Reserved: 21, 29, 39-56 */
                            return 1;
                        }
                        if (op == 30 || op == 31 || op >= 58) {
P
pbrook 已提交
5524 5525
                            tcg_gen_st_f32(cpu_F0s, cpu_env,
                                           neon_reg_offset(rd, pass));
P
pbrook 已提交
5526
                        } else {
5527
                            neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
5528 5529 5530 5531 5532 5533
                        }
                    }
                    break;
                }
            } else if ((insn & (1 << 10)) == 0) {
                /* VTBL, VTBX.  */
P
pbrook 已提交
5534
                n = ((insn >> 5) & 0x18) + 8;
P
pbrook 已提交
5535
                if (insn & (1 << 6)) {
P
pbrook 已提交
5536
                    tmp = neon_load_reg(rd, 0);
P
pbrook 已提交
5537
                } else {
P
pbrook 已提交
5538 5539
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
5540
                }
P
pbrook 已提交
5541
                tmp2 = neon_load_reg(rm, 0);
5542 5543 5544
                tmp4 = tcg_const_i32(rn);
                tmp5 = tcg_const_i32(n);
                gen_helper_neon_tbl(tmp2, tmp2, tmp, tmp4, tmp5);
P
pbrook 已提交
5545
                dead_tmp(tmp);
P
pbrook 已提交
5546
                if (insn & (1 << 6)) {
P
pbrook 已提交
5547
                    tmp = neon_load_reg(rd, 1);
P
pbrook 已提交
5548
                } else {
P
pbrook 已提交
5549 5550
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
5551
                }
P
pbrook 已提交
5552
                tmp3 = neon_load_reg(rm, 1);
5553 5554 5555
                gen_helper_neon_tbl(tmp3, tmp3, tmp, tmp4, tmp5);
                dead_tmp(tmp5);
                dead_tmp(tmp4);
P
pbrook 已提交
5556
                neon_store_reg(rd, 0, tmp2);
P
pbrook 已提交
5557 5558
                neon_store_reg(rd, 1, tmp3);
                dead_tmp(tmp);
P
pbrook 已提交
5559 5560 5561
            } else if ((insn & 0x380) == 0) {
                /* VDUP */
                if (insn & (1 << 19)) {
5562
                    tmp = neon_load_reg(rm, 1);
P
pbrook 已提交
5563
                } else {
5564
                    tmp = neon_load_reg(rm, 0);
P
pbrook 已提交
5565 5566
                }
                if (insn & (1 << 16)) {
5567
                    gen_neon_dup_u8(tmp, ((insn >> 17) & 3) * 8);
P
pbrook 已提交
5568 5569
                } else if (insn & (1 << 17)) {
                    if ((insn >> 18) & 1)
5570
                        gen_neon_dup_high16(tmp);
P
pbrook 已提交
5571
                    else
5572
                        gen_neon_dup_low16(tmp);
P
pbrook 已提交
5573 5574
                }
                for (pass = 0; pass < (q ? 4 : 2); pass++) {
5575 5576 5577
                    tmp2 = new_tmp();
                    tcg_gen_mov_i32(tmp2, tmp);
                    neon_store_reg(rd, pass, tmp2);
P
pbrook 已提交
5578
                }
5579
                dead_tmp(tmp);
P
pbrook 已提交
5580 5581 5582 5583 5584 5585 5586 5587
            } else {
                return 1;
            }
        }
    }
    return 0;
}

5588 5589 5590 5591 5592 5593 5594 5595 5596 5597 5598 5599 5600 5601 5602 5603 5604 5605 5606 5607 5608 5609 5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620 5621 5622 5623 5624 5625 5626 5627 5628 5629 5630 5631 5632 5633 5634 5635 5636 5637 5638 5639 5640 5641 5642 5643 5644 5645 5646 5647 5648 5649 5650 5651 5652
static int disas_cp14_read(CPUState * env, DisasContext *s, uint32_t insn)
{
    int crn = (insn >> 16) & 0xf;
    int crm = insn & 0xf;
    int op1 = (insn >> 21) & 7;
    int op2 = (insn >> 5) & 7;
    int rt = (insn >> 12) & 0xf;
    TCGv tmp;

    if (arm_feature(env, ARM_FEATURE_THUMB2EE)) {
        if (op1 == 6 && crn == 0 && crm == 0 && op2 == 0) {
            /* TEECR */
            if (IS_USER(s))
                return 1;
            tmp = load_cpu_field(teecr);
            store_reg(s, rt, tmp);
            return 0;
        }
        if (op1 == 6 && crn == 1 && crm == 0 && op2 == 0) {
            /* TEEHBR */
            if (IS_USER(s) && (env->teecr & 1))
                return 1;
            tmp = load_cpu_field(teehbr);
            store_reg(s, rt, tmp);
            return 0;
        }
    }
    fprintf(stderr, "Unknown cp14 read op1:%d crn:%d crm:%d op2:%d\n",
            op1, crn, crm, op2);
    return 1;
}

static int disas_cp14_write(CPUState * env, DisasContext *s, uint32_t insn)
{
    int crn = (insn >> 16) & 0xf;
    int crm = insn & 0xf;
    int op1 = (insn >> 21) & 7;
    int op2 = (insn >> 5) & 7;
    int rt = (insn >> 12) & 0xf;
    TCGv tmp;

    if (arm_feature(env, ARM_FEATURE_THUMB2EE)) {
        if (op1 == 6 && crn == 0 && crm == 0 && op2 == 0) {
            /* TEECR */
            if (IS_USER(s))
                return 1;
            tmp = load_reg(s, rt);
            gen_helper_set_teecr(cpu_env, tmp);
            dead_tmp(tmp);
            return 0;
        }
        if (op1 == 6 && crn == 1 && crm == 0 && op2 == 0) {
            /* TEEHBR */
            if (IS_USER(s) && (env->teecr & 1))
                return 1;
            tmp = load_reg(s, rt);
            store_cpu_field(tmp, teehbr);
            return 0;
        }
    }
    fprintf(stderr, "Unknown cp14 write op1:%d crn:%d crm:%d op2:%d\n",
            op1, crn, crm, op2);
    return 1;
}

P
pbrook 已提交
5653 5654 5655 5656 5657 5658 5659 5660 5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673
static int disas_coproc_insn(CPUState * env, DisasContext *s, uint32_t insn)
{
    int cpnum;

    cpnum = (insn >> 8) & 0xf;
    if (arm_feature(env, ARM_FEATURE_XSCALE)
	    && ((env->cp15.c15_cpar ^ 0x3fff) & (1 << cpnum)))
	return 1;

    switch (cpnum) {
      case 0:
      case 1:
	if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
	    return disas_iwmmxt_insn(env, s, insn);
	} else if (arm_feature(env, ARM_FEATURE_XSCALE)) {
	    return disas_dsp_insn(env, s, insn);
	}
	return 1;
    case 10:
    case 11:
	return disas_vfp_insn (env, s, insn);
5674 5675 5676 5677 5678 5679 5680 5681 5682
    case 14:
        /* Coprocessors 7-15 are architecturally reserved by ARM.
           Unfortunately Intel decided to ignore this.  */
        if (arm_feature(env, ARM_FEATURE_XSCALE))
            goto board;
        if (insn & (1 << 20))
            return disas_cp14_read(env, s, insn);
        else
            return disas_cp14_write(env, s, insn);
P
pbrook 已提交
5683 5684 5685
    case 15:
	return disas_cp15_insn (env, s, insn);
    default:
5686
    board:
P
pbrook 已提交
5687 5688 5689 5690 5691
	/* Unknown coprocessor.  See if the board has hooked it.  */
	return disas_cp_insn (env, s, insn);
    }
}

P
pbrook 已提交
5692 5693

/* Store a 64-bit value to a register pair.  Clobbers val.  */
P
pbrook 已提交
5694
static void gen_storeq_reg(DisasContext *s, int rlow, int rhigh, TCGv_i64 val)
P
pbrook 已提交
5695 5696 5697 5698 5699 5700 5701 5702 5703 5704 5705 5706
{
    TCGv tmp;
    tmp = new_tmp();
    tcg_gen_trunc_i64_i32(tmp, val);
    store_reg(s, rlow, tmp);
    tmp = new_tmp();
    tcg_gen_shri_i64(val, val, 32);
    tcg_gen_trunc_i64_i32(tmp, val);
    store_reg(s, rhigh, tmp);
}

/* load a 32-bit value from a register and perform a 64-bit accumulate.  */
P
pbrook 已提交
5707
static void gen_addq_lo(DisasContext *s, TCGv_i64 val, int rlow)
P
pbrook 已提交
5708
{
P
pbrook 已提交
5709
    TCGv_i64 tmp;
P
pbrook 已提交
5710 5711
    TCGv tmp2;

P
pbrook 已提交
5712
    /* Load value and extend to 64 bits.  */
P
pbrook 已提交
5713
    tmp = tcg_temp_new_i64();
P
pbrook 已提交
5714 5715 5716 5717
    tmp2 = load_reg(s, rlow);
    tcg_gen_extu_i32_i64(tmp, tmp2);
    dead_tmp(tmp2);
    tcg_gen_add_i64(val, val, tmp);
5718
    tcg_temp_free_i64(tmp);
P
pbrook 已提交
5719 5720 5721
}

/* load and add a 64-bit value from a register pair.  */
P
pbrook 已提交
5722
static void gen_addq(DisasContext *s, TCGv_i64 val, int rlow, int rhigh)
P
pbrook 已提交
5723
{
P
pbrook 已提交
5724
    TCGv_i64 tmp;
P
pbrook 已提交
5725 5726
    TCGv tmpl;
    TCGv tmph;
P
pbrook 已提交
5727 5728

    /* Load 64-bit value rd:rn.  */
P
pbrook 已提交
5729 5730
    tmpl = load_reg(s, rlow);
    tmph = load_reg(s, rhigh);
P
pbrook 已提交
5731
    tmp = tcg_temp_new_i64();
P
pbrook 已提交
5732 5733 5734
    tcg_gen_concat_i32_i64(tmp, tmpl, tmph);
    dead_tmp(tmpl);
    dead_tmp(tmph);
P
pbrook 已提交
5735
    tcg_gen_add_i64(val, val, tmp);
5736
    tcg_temp_free_i64(tmp);
P
pbrook 已提交
5737 5738 5739
}

/* Set N and Z flags from a 64-bit value.  */
P
pbrook 已提交
5740
static void gen_logicq_cc(TCGv_i64 val)
P
pbrook 已提交
5741 5742 5743
{
    TCGv tmp = new_tmp();
    gen_helper_logicq_cc(tmp, val);
P
pbrook 已提交
5744 5745
    gen_logic_CC(tmp);
    dead_tmp(tmp);
P
pbrook 已提交
5746 5747
}

P
pbrook 已提交
5748 5749 5750
static void disas_arm_insn(CPUState * env, DisasContext *s)
{
    unsigned int cond, insn, val, op1, i, shift, rm, rs, rn, rd, sh;
P
pbrook 已提交
5751
    TCGv tmp;
P
pbrook 已提交
5752
    TCGv tmp2;
P
pbrook 已提交
5753
    TCGv tmp3;
P
pbrook 已提交
5754
    TCGv addr;
P
pbrook 已提交
5755
    TCGv_i64 tmp64;
P
pbrook 已提交
5756 5757 5758 5759 5760 5761 5762 5763 5764 5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775 5776 5777 5778 5779 5780 5781 5782 5783 5784 5785 5786 5787 5788 5789 5790 5791 5792 5793 5794 5795 5796 5797

    insn = ldl_code(s->pc);
    s->pc += 4;

    /* M variants do not implement ARM mode.  */
    if (IS_M(env))
        goto illegal_op;
    cond = insn >> 28;
    if (cond == 0xf){
        /* Unconditional instructions.  */
        if (((insn >> 25) & 7) == 1) {
            /* NEON Data processing.  */
            if (!arm_feature(env, ARM_FEATURE_NEON))
                goto illegal_op;

            if (disas_neon_data_insn(env, s, insn))
                goto illegal_op;
            return;
        }
        if ((insn & 0x0f100000) == 0x04000000) {
            /* NEON load/store.  */
            if (!arm_feature(env, ARM_FEATURE_NEON))
                goto illegal_op;

            if (disas_neon_ls_insn(env, s, insn))
                goto illegal_op;
            return;
        }
        if ((insn & 0x0d70f000) == 0x0550f000)
            return; /* PLD */
        else if ((insn & 0x0ffffdff) == 0x01010000) {
            ARCH(6);
            /* setend */
            if (insn & (1 << 9)) {
                /* BE8 mode not implemented.  */
                goto illegal_op;
            }
            return;
        } else if ((insn & 0x0fffff00) == 0x057ff000) {
            switch ((insn >> 4) & 0xf) {
            case 1: /* clrex */
                ARCH(6K);
P
pbrook 已提交
5798
                gen_helper_clrex(cpu_env);
P
pbrook 已提交
5799 5800 5801 5802 5803 5804 5805 5806 5807 5808 5809 5810
                return;
            case 4: /* dsb */
            case 5: /* dmb */
            case 6: /* isb */
                ARCH(7);
                /* We don't emulate caches so these are a no-op.  */
                return;
            default:
                goto illegal_op;
            }
        } else if ((insn & 0x0e5fffe0) == 0x084d0500) {
            /* srs */
5811
            int32_t offset;
P
pbrook 已提交
5812 5813 5814 5815 5816
            if (IS_USER(s))
                goto illegal_op;
            ARCH(6);
            op1 = (insn & 0x1f);
            if (op1 == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
5817
                addr = load_reg(s, 13);
P
pbrook 已提交
5818
            } else {
P
pbrook 已提交
5819
                addr = new_tmp();
5820 5821 5822
                tmp = tcg_const_i32(op1);
                gen_helper_get_r13_banked(addr, cpu_env, tmp);
                tcg_temp_free_i32(tmp);
P
pbrook 已提交
5823 5824 5825 5826
            }
            i = (insn >> 23) & 3;
            switch (i) {
            case 0: offset = -4; break; /* DA */
5827 5828
            case 1: offset = 0; break; /* IA */
            case 2: offset = -8; break; /* DB */
P
pbrook 已提交
5829 5830 5831 5832
            case 3: offset = 4; break; /* IB */
            default: abort();
            }
            if (offset)
P
pbrook 已提交
5833 5834 5835
                tcg_gen_addi_i32(addr, addr, offset);
            tmp = load_reg(s, 14);
            gen_st32(tmp, addr, 0);
5836
            tmp = load_cpu_field(spsr);
P
pbrook 已提交
5837 5838
            tcg_gen_addi_i32(addr, addr, 4);
            gen_st32(tmp, addr, 0);
P
pbrook 已提交
5839 5840 5841 5842
            if (insn & (1 << 21)) {
                /* Base writeback.  */
                switch (i) {
                case 0: offset = -8; break;
5843 5844
                case 1: offset = 4; break;
                case 2: offset = -4; break;
P
pbrook 已提交
5845 5846 5847 5848
                case 3: offset = 0; break;
                default: abort();
                }
                if (offset)
5849
                    tcg_gen_addi_i32(addr, addr, offset);
P
pbrook 已提交
5850
                if (op1 == (env->uncached_cpsr & CPSR_M)) {
5851
                    store_reg(s, 13, addr);
P
pbrook 已提交
5852
                } else {
5853 5854 5855
                    tmp = tcg_const_i32(op1);
                    gen_helper_set_r13_banked(cpu_env, tmp, addr);
                    tcg_temp_free_i32(tmp);
5856
                    dead_tmp(addr);
P
pbrook 已提交
5857
                }
P
pbrook 已提交
5858 5859
            } else {
                dead_tmp(addr);
P
pbrook 已提交
5860 5861 5862
            }
        } else if ((insn & 0x0e5fffe0) == 0x081d0a00) {
            /* rfe */
5863
            int32_t offset;
P
pbrook 已提交
5864 5865 5866 5867
            if (IS_USER(s))
                goto illegal_op;
            ARCH(6);
            rn = (insn >> 16) & 0xf;
P
pbrook 已提交
5868
            addr = load_reg(s, rn);
P
pbrook 已提交
5869 5870
            i = (insn >> 23) & 3;
            switch (i) {
P
pbrook 已提交
5871
            case 0: offset = -4; break; /* DA */
5872 5873
            case 1: offset = 0; break; /* IA */
            case 2: offset = -8; break; /* DB */
P
pbrook 已提交
5874
            case 3: offset = 4; break; /* IB */
P
pbrook 已提交
5875 5876 5877
            default: abort();
            }
            if (offset)
P
pbrook 已提交
5878 5879 5880 5881 5882
                tcg_gen_addi_i32(addr, addr, offset);
            /* Load PC into tmp and CPSR into tmp2.  */
            tmp = gen_ld32(addr, 0);
            tcg_gen_addi_i32(addr, addr, 4);
            tmp2 = gen_ld32(addr, 0);
P
pbrook 已提交
5883 5884 5885
            if (insn & (1 << 21)) {
                /* Base writeback.  */
                switch (i) {
P
pbrook 已提交
5886
                case 0: offset = -8; break;
5887 5888
                case 1: offset = 4; break;
                case 2: offset = -4; break;
P
pbrook 已提交
5889
                case 3: offset = 0; break;
P
pbrook 已提交
5890 5891 5892
                default: abort();
                }
                if (offset)
P
pbrook 已提交
5893 5894 5895 5896
                    tcg_gen_addi_i32(addr, addr, offset);
                store_reg(s, rn, addr);
            } else {
                dead_tmp(addr);
P
pbrook 已提交
5897
            }
P
pbrook 已提交
5898
            gen_rfe(s, tmp, tmp2);
5899
            return;
P
pbrook 已提交
5900 5901 5902 5903 5904
        } else if ((insn & 0x0e000000) == 0x0a000000) {
            /* branch link and change to thumb (blx <offset>) */
            int32_t offset;

            val = (uint32_t)s->pc;
P
pbrook 已提交
5905 5906 5907
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, val);
            store_reg(s, 14, tmp);
P
pbrook 已提交
5908 5909 5910 5911 5912 5913
            /* Sign-extend the 24-bit offset */
            offset = (((int32_t)insn) << 8) >> 8;
            /* offset * 4 + bit24 * 2 + (thumb bit) */
            val += (offset << 2) | ((insn >> 23) & 2) | 1;
            /* pipeline offset */
            val += 4;
P
pbrook 已提交
5914
            gen_bx_im(s, val);
P
pbrook 已提交
5915 5916 5917 5918 5919 5920 5921 5922 5923 5924 5925 5926
            return;
        } else if ((insn & 0x0e000f00) == 0x0c000100) {
            if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
                /* iWMMXt register transfer.  */
                if (env->cp15.c15_cpar & (1 << 1))
                    if (!disas_iwmmxt_insn(env, s, insn))
                        return;
            }
        } else if ((insn & 0x0fe00000) == 0x0c400000) {
            /* Coprocessor double register transfer.  */
        } else if ((insn & 0x0f000010) == 0x0e000010) {
            /* Additional coprocessor register transfer.  */
B
balrog 已提交
5927
        } else if ((insn & 0x0ff10020) == 0x01000000) {
P
pbrook 已提交
5928 5929 5930 5931 5932 5933 5934 5935 5936 5937 5938 5939 5940 5941 5942 5943
            uint32_t mask;
            uint32_t val;
            /* cps (privileged) */
            if (IS_USER(s))
                return;
            mask = val = 0;
            if (insn & (1 << 19)) {
                if (insn & (1 << 8))
                    mask |= CPSR_A;
                if (insn & (1 << 7))
                    mask |= CPSR_I;
                if (insn & (1 << 6))
                    mask |= CPSR_F;
                if (insn & (1 << 18))
                    val |= mask;
            }
B
balrog 已提交
5944
            if (insn & (1 << 17)) {
P
pbrook 已提交
5945 5946 5947 5948
                mask |= CPSR_M;
                val |= (insn & 0x1f);
            }
            if (mask) {
5949
                gen_set_psr_im(s, mask, 0, val);
P
pbrook 已提交
5950 5951 5952 5953 5954 5955 5956 5957 5958
            }
            return;
        }
        goto illegal_op;
    }
    if (cond != 0xe) {
        /* if not always execute, we generate a conditional jump to
           next instruction */
        s->condlabel = gen_new_label();
P
pbrook 已提交
5959
        gen_test_cc(cond ^ 1, s->condlabel);
P
pbrook 已提交
5960 5961 5962 5963 5964 5965 5966 5967 5968
        s->condjmp = 1;
    }
    if ((insn & 0x0f900000) == 0x03000000) {
        if ((insn & (1 << 21)) == 0) {
            ARCH(6T2);
            rd = (insn >> 12) & 0xf;
            val = ((insn >> 4) & 0xf000) | (insn & 0xfff);
            if ((insn & (1 << 22)) == 0) {
                /* MOVW */
P
pbrook 已提交
5969 5970
                tmp = new_tmp();
                tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
5971 5972
            } else {
                /* MOVT */
P
pbrook 已提交
5973
                tmp = load_reg(s, rd);
P
pbrook 已提交
5974
                tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
5975
                tcg_gen_ori_i32(tmp, tmp, val << 16);
P
pbrook 已提交
5976
            }
P
pbrook 已提交
5977
            store_reg(s, rd, tmp);
P
pbrook 已提交
5978 5979 5980 5981 5982 5983 5984 5985 5986 5987 5988 5989
        } else {
            if (((insn >> 12) & 0xf) != 0xf)
                goto illegal_op;
            if (((insn >> 16) & 0xf) == 0) {
                gen_nop_hint(s, insn & 0xff);
            } else {
                /* CPSR = immediate */
                val = insn & 0xff;
                shift = ((insn >> 8) & 0xf) * 2;
                if (shift)
                    val = (val >> shift) | (val << (32 - shift));
                i = ((insn & (1 << 22)) != 0);
5990
                if (gen_set_psr_im(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, val))
P
pbrook 已提交
5991 5992 5993 5994 5995 5996 5997 5998 5999 6000 6001 6002 6003
                    goto illegal_op;
            }
        }
    } else if ((insn & 0x0f900000) == 0x01000000
               && (insn & 0x00000090) != 0x00000090) {
        /* miscellaneous instructions */
        op1 = (insn >> 21) & 3;
        sh = (insn >> 4) & 0xf;
        rm = insn & 0xf;
        switch (sh) {
        case 0x0: /* move program status register */
            if (op1 & 1) {
                /* PSR = reg */
6004
                tmp = load_reg(s, rm);
P
pbrook 已提交
6005
                i = ((op1 & 2) != 0);
6006
                if (gen_set_psr(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, tmp))
P
pbrook 已提交
6007 6008 6009 6010 6011 6012 6013
                    goto illegal_op;
            } else {
                /* reg = PSR */
                rd = (insn >> 12) & 0xf;
                if (op1 & 2) {
                    if (IS_USER(s))
                        goto illegal_op;
P
pbrook 已提交
6014
                    tmp = load_cpu_field(spsr);
P
pbrook 已提交
6015
                } else {
P
pbrook 已提交
6016 6017
                    tmp = new_tmp();
                    gen_helper_cpsr_read(tmp);
P
pbrook 已提交
6018
                }
P
pbrook 已提交
6019
                store_reg(s, rd, tmp);
P
pbrook 已提交
6020 6021 6022 6023 6024
            }
            break;
        case 0x1:
            if (op1 == 1) {
                /* branch/exchange thumb (bx).  */
P
pbrook 已提交
6025 6026
                tmp = load_reg(s, rm);
                gen_bx(s, tmp);
P
pbrook 已提交
6027 6028 6029
            } else if (op1 == 3) {
                /* clz */
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6030 6031 6032
                tmp = load_reg(s, rm);
                gen_helper_clz(tmp, tmp);
                store_reg(s, rd, tmp);
P
pbrook 已提交
6033 6034 6035 6036 6037 6038 6039 6040
            } else {
                goto illegal_op;
            }
            break;
        case 0x2:
            if (op1 == 1) {
                ARCH(5J); /* bxj */
                /* Trivial implementation equivalent to bx.  */
P
pbrook 已提交
6041 6042
                tmp = load_reg(s, rm);
                gen_bx(s, tmp);
P
pbrook 已提交
6043 6044 6045 6046 6047 6048 6049 6050 6051
            } else {
                goto illegal_op;
            }
            break;
        case 0x3:
            if (op1 != 1)
              goto illegal_op;

            /* branch link/exchange thumb (blx) */
P
pbrook 已提交
6052 6053 6054 6055 6056
            tmp = load_reg(s, rm);
            tmp2 = new_tmp();
            tcg_gen_movi_i32(tmp2, s->pc);
            store_reg(s, 14, tmp2);
            gen_bx(s, tmp);
P
pbrook 已提交
6057 6058 6059 6060
            break;
        case 0x5: /* saturating add/subtract */
            rd = (insn >> 12) & 0xf;
            rn = (insn >> 16) & 0xf;
6061
            tmp = load_reg(s, rm);
P
pbrook 已提交
6062
            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6063
            if (op1 & 2)
P
pbrook 已提交
6064
                gen_helper_double_saturate(tmp2, tmp2);
P
pbrook 已提交
6065
            if (op1 & 1)
P
pbrook 已提交
6066
                gen_helper_sub_saturate(tmp, tmp, tmp2);
P
pbrook 已提交
6067
            else
P
pbrook 已提交
6068 6069 6070
                gen_helper_add_saturate(tmp, tmp, tmp2);
            dead_tmp(tmp2);
            store_reg(s, rd, tmp);
P
pbrook 已提交
6071 6072 6073
            break;
        case 7: /* bkpt */
            gen_set_condexec(s);
P
pbrook 已提交
6074
            gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
6075
            gen_exception(EXCP_BKPT);
P
pbrook 已提交
6076 6077 6078 6079 6080 6081 6082 6083 6084 6085 6086
            s->is_jmp = DISAS_JUMP;
            break;
        case 0x8: /* signed multiply */
        case 0xa:
        case 0xc:
        case 0xe:
            rs = (insn >> 8) & 0xf;
            rn = (insn >> 12) & 0xf;
            rd = (insn >> 16) & 0xf;
            if (op1 == 1) {
                /* (32 * 16) >> 16 */
P
pbrook 已提交
6087 6088
                tmp = load_reg(s, rm);
                tmp2 = load_reg(s, rs);
P
pbrook 已提交
6089
                if (sh & 4)
P
pbrook 已提交
6090
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
P
pbrook 已提交
6091
                else
P
pbrook 已提交
6092
                    gen_sxth(tmp2);
P
pbrook 已提交
6093 6094
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
                tcg_gen_shri_i64(tmp64, tmp64, 16);
P
pbrook 已提交
6095
                tmp = new_tmp();
P
pbrook 已提交
6096
                tcg_gen_trunc_i64_i32(tmp, tmp64);
6097
                tcg_temp_free_i64(tmp64);
P
pbrook 已提交
6098
                if ((sh & 2) == 0) {
P
pbrook 已提交
6099 6100 6101
                    tmp2 = load_reg(s, rn);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
6102
                }
P
pbrook 已提交
6103
                store_reg(s, rd, tmp);
P
pbrook 已提交
6104 6105
            } else {
                /* 16 * 16 */
P
pbrook 已提交
6106 6107 6108 6109
                tmp = load_reg(s, rm);
                tmp2 = load_reg(s, rs);
                gen_mulxy(tmp, tmp2, sh & 2, sh & 4);
                dead_tmp(tmp2);
P
pbrook 已提交
6110
                if (op1 == 2) {
P
pbrook 已提交
6111 6112
                    tmp64 = tcg_temp_new_i64();
                    tcg_gen_ext_i32_i64(tmp64, tmp);
6113
                    dead_tmp(tmp);
P
pbrook 已提交
6114 6115
                    gen_addq(s, tmp64, rn, rd);
                    gen_storeq_reg(s, rn, rd, tmp64);
6116
                    tcg_temp_free_i64(tmp64);
P
pbrook 已提交
6117 6118
                } else {
                    if (op1 == 0) {
P
pbrook 已提交
6119 6120 6121
                        tmp2 = load_reg(s, rn);
                        gen_helper_add_setq(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
P
pbrook 已提交
6122
                    }
P
pbrook 已提交
6123
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6124 6125 6126 6127 6128 6129 6130 6131 6132 6133 6134 6135 6136 6137 6138 6139 6140 6141 6142 6143
                }
            }
            break;
        default:
            goto illegal_op;
        }
    } else if (((insn & 0x0e000000) == 0 &&
                (insn & 0x00000090) != 0x90) ||
               ((insn & 0x0e000000) == (1 << 25))) {
        int set_cc, logic_cc, shiftop;

        op1 = (insn >> 21) & 0xf;
        set_cc = (insn >> 20) & 1;
        logic_cc = table_logic_cc[op1] & set_cc;

        /* data processing instruction */
        if (insn & (1 << 25)) {
            /* immediate operand */
            val = insn & 0xff;
            shift = ((insn >> 8) & 0xf) * 2;
6144
            if (shift) {
P
pbrook 已提交
6145
                val = (val >> shift) | (val << (32 - shift));
6146 6147 6148 6149 6150 6151
            }
            tmp2 = new_tmp();
            tcg_gen_movi_i32(tmp2, val);
            if (logic_cc && shift) {
                gen_set_CF_bit31(tmp2);
            }
P
pbrook 已提交
6152 6153 6154
        } else {
            /* register */
            rm = (insn) & 0xf;
6155
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
6156 6157 6158
            shiftop = (insn >> 5) & 3;
            if (!(insn & (1 << 4))) {
                shift = (insn >> 7) & 0x1f;
6159
                gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
P
pbrook 已提交
6160 6161
            } else {
                rs = (insn >> 8) & 0xf;
P
pbrook 已提交
6162
                tmp = load_reg(s, rs);
6163
                gen_arm_shift_reg(tmp2, shiftop, tmp, logic_cc);
P
pbrook 已提交
6164 6165 6166 6167
            }
        }
        if (op1 != 0x0f && op1 != 0x0d) {
            rn = (insn >> 16) & 0xf;
6168 6169 6170
            tmp = load_reg(s, rn);
        } else {
            TCGV_UNUSED(tmp);
P
pbrook 已提交
6171 6172 6173 6174
        }
        rd = (insn >> 12) & 0xf;
        switch(op1) {
        case 0x00:
6175 6176 6177 6178
            tcg_gen_and_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6179
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6180 6181
            break;
        case 0x01:
6182 6183 6184 6185
            tcg_gen_xor_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6186
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6187 6188 6189 6190
            break;
        case 0x02:
            if (set_cc && rd == 15) {
                /* SUBS r15, ... is used for exception return.  */
6191
                if (IS_USER(s)) {
P
pbrook 已提交
6192
                    goto illegal_op;
6193 6194 6195
                }
                gen_helper_sub_cc(tmp, tmp, tmp2);
                gen_exception_return(s, tmp);
P
pbrook 已提交
6196
            } else {
6197 6198 6199 6200 6201
                if (set_cc) {
                    gen_helper_sub_cc(tmp, tmp, tmp2);
                } else {
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
                }
6202
                store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6203 6204 6205
            }
            break;
        case 0x03:
6206 6207 6208 6209 6210
            if (set_cc) {
                gen_helper_sub_cc(tmp, tmp2, tmp);
            } else {
                tcg_gen_sub_i32(tmp, tmp2, tmp);
            }
6211
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6212 6213
            break;
        case 0x04:
6214 6215 6216 6217 6218
            if (set_cc) {
                gen_helper_add_cc(tmp, tmp, tmp2);
            } else {
                tcg_gen_add_i32(tmp, tmp, tmp2);
            }
6219
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6220 6221
            break;
        case 0x05:
6222 6223 6224 6225 6226
            if (set_cc) {
                gen_helper_adc_cc(tmp, tmp, tmp2);
            } else {
                gen_add_carry(tmp, tmp, tmp2);
            }
6227
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6228 6229
            break;
        case 0x06:
6230 6231 6232 6233 6234
            if (set_cc) {
                gen_helper_sbc_cc(tmp, tmp, tmp2);
            } else {
                gen_sub_carry(tmp, tmp, tmp2);
            }
6235
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6236 6237
            break;
        case 0x07:
6238 6239 6240 6241 6242
            if (set_cc) {
                gen_helper_sbc_cc(tmp, tmp2, tmp);
            } else {
                gen_sub_carry(tmp, tmp2, tmp);
            }
6243
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6244 6245 6246
            break;
        case 0x08:
            if (set_cc) {
6247 6248
                tcg_gen_and_i32(tmp, tmp, tmp2);
                gen_logic_CC(tmp);
P
pbrook 已提交
6249
            }
6250
            dead_tmp(tmp);
P
pbrook 已提交
6251 6252 6253
            break;
        case 0x09:
            if (set_cc) {
6254 6255
                tcg_gen_xor_i32(tmp, tmp, tmp2);
                gen_logic_CC(tmp);
P
pbrook 已提交
6256
            }
6257
            dead_tmp(tmp);
P
pbrook 已提交
6258 6259 6260
            break;
        case 0x0a:
            if (set_cc) {
6261
                gen_helper_sub_cc(tmp, tmp, tmp2);
P
pbrook 已提交
6262
            }
6263
            dead_tmp(tmp);
P
pbrook 已提交
6264 6265 6266
            break;
        case 0x0b:
            if (set_cc) {
6267
                gen_helper_add_cc(tmp, tmp, tmp2);
P
pbrook 已提交
6268
            }
6269
            dead_tmp(tmp);
P
pbrook 已提交
6270 6271
            break;
        case 0x0c:
6272 6273 6274 6275
            tcg_gen_or_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6276
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6277 6278 6279 6280
            break;
        case 0x0d:
            if (logic_cc && rd == 15) {
                /* MOVS r15, ... is used for exception return.  */
6281
                if (IS_USER(s)) {
P
pbrook 已提交
6282
                    goto illegal_op;
6283 6284
                }
                gen_exception_return(s, tmp2);
P
pbrook 已提交
6285
            } else {
6286 6287 6288
                if (logic_cc) {
                    gen_logic_CC(tmp2);
                }
6289
                store_reg_bx(env, s, rd, tmp2);
P
pbrook 已提交
6290 6291 6292
            }
            break;
        case 0x0e:
6293 6294 6295 6296
            tcg_gen_bic_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6297
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6298 6299 6300
            break;
        default:
        case 0x0f:
6301 6302 6303 6304
            tcg_gen_not_i32(tmp2, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp2);
            }
6305
            store_reg_bx(env, s, rd, tmp2);
P
pbrook 已提交
6306 6307
            break;
        }
6308 6309 6310
        if (op1 != 0x0f && op1 != 0x0d) {
            dead_tmp(tmp2);
        }
P
pbrook 已提交
6311 6312 6313 6314 6315 6316 6317 6318 6319 6320 6321 6322 6323 6324 6325 6326 6327 6328
    } else {
        /* other instructions */
        op1 = (insn >> 24) & 0xf;
        switch(op1) {
        case 0x0:
        case 0x1:
            /* multiplies, extra load/stores */
            sh = (insn >> 5) & 3;
            if (sh == 0) {
                if (op1 == 0x0) {
                    rd = (insn >> 16) & 0xf;
                    rn = (insn >> 12) & 0xf;
                    rs = (insn >> 8) & 0xf;
                    rm = (insn) & 0xf;
                    op1 = (insn >> 20) & 0xf;
                    switch (op1) {
                    case 0: case 1: case 2: case 3: case 6:
                        /* 32 bit mul */
P
pbrook 已提交
6329 6330 6331 6332
                        tmp = load_reg(s, rs);
                        tmp2 = load_reg(s, rm);
                        tcg_gen_mul_i32(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
P
pbrook 已提交
6333 6334 6335
                        if (insn & (1 << 22)) {
                            /* Subtract (mls) */
                            ARCH(6T2);
P
pbrook 已提交
6336 6337 6338
                            tmp2 = load_reg(s, rn);
                            tcg_gen_sub_i32(tmp, tmp2, tmp);
                            dead_tmp(tmp2);
P
pbrook 已提交
6339 6340
                        } else if (insn & (1 << 21)) {
                            /* Add */
P
pbrook 已提交
6341 6342 6343
                            tmp2 = load_reg(s, rn);
                            tcg_gen_add_i32(tmp, tmp, tmp2);
                            dead_tmp(tmp2);
P
pbrook 已提交
6344 6345
                        }
                        if (insn & (1 << 20))
P
pbrook 已提交
6346 6347
                            gen_logic_CC(tmp);
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6348 6349 6350
                        break;
                    default:
                        /* 64 bit mul */
P
pbrook 已提交
6351 6352
                        tmp = load_reg(s, rs);
                        tmp2 = load_reg(s, rm);
P
pbrook 已提交
6353
                        if (insn & (1 << 22))
P
pbrook 已提交
6354
                            tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
6355
                        else
P
pbrook 已提交
6356
                            tmp64 = gen_mulu_i64_i32(tmp, tmp2);
P
pbrook 已提交
6357
                        if (insn & (1 << 21)) /* mult accumulate */
P
pbrook 已提交
6358
                            gen_addq(s, tmp64, rn, rd);
P
pbrook 已提交
6359 6360
                        if (!(insn & (1 << 23))) { /* double accumulate */
                            ARCH(6);
P
pbrook 已提交
6361 6362
                            gen_addq_lo(s, tmp64, rn);
                            gen_addq_lo(s, tmp64, rd);
P
pbrook 已提交
6363 6364
                        }
                        if (insn & (1 << 20))
P
pbrook 已提交
6365 6366
                            gen_logicq_cc(tmp64);
                        gen_storeq_reg(s, rn, rd, tmp64);
6367
                        tcg_temp_free_i64(tmp64);
P
pbrook 已提交
6368 6369 6370 6371 6372 6373 6374
                        break;
                    }
                } else {
                    rn = (insn >> 16) & 0xf;
                    rd = (insn >> 12) & 0xf;
                    if (insn & (1 << 23)) {
                        /* load/store exclusive */
P
pbrook 已提交
6375 6376
                        op1 = (insn >> 21) & 0x3;
                        if (op1)
6377
                            ARCH(6K);
P
pbrook 已提交
6378 6379
                        else
                            ARCH(6);
6380
                        addr = tcg_temp_local_new_i32();
6381
                        load_reg_var(s, addr, rn);
P
pbrook 已提交
6382
                        if (insn & (1 << 20)) {
6383
                            gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
6384 6385 6386 6387 6388 6389 6390 6391 6392 6393 6394 6395 6396 6397 6398 6399 6400 6401 6402 6403
                            switch (op1) {
                            case 0: /* ldrex */
                                tmp = gen_ld32(addr, IS_USER(s));
                                break;
                            case 1: /* ldrexd */
                                tmp = gen_ld32(addr, IS_USER(s));
                                store_reg(s, rd, tmp);
                                tcg_gen_addi_i32(addr, addr, 4);
                                tmp = gen_ld32(addr, IS_USER(s));
                                rd++;
                                break;
                            case 2: /* ldrexb */
                                tmp = gen_ld8u(addr, IS_USER(s));
                                break;
                            case 3: /* ldrexh */
                                tmp = gen_ld16u(addr, IS_USER(s));
                                break;
                            default:
                                abort();
                            }
P
pbrook 已提交
6404
                            store_reg(s, rd, tmp);
P
pbrook 已提交
6405
                        } else {
P
pbrook 已提交
6406
                            int label = gen_new_label();
P
pbrook 已提交
6407
                            rm = insn & 0xf;
6408 6409 6410
                            tmp2 = tcg_temp_local_new_i32();
                            gen_helper_test_exclusive(tmp2, cpu_env, addr);
                            tcg_gen_brcondi_i32(TCG_COND_NE, tmp2, 0, label);
P
pbrook 已提交
6411
                            tmp = load_reg(s,rm);
P
pbrook 已提交
6412 6413 6414 6415 6416 6417 6418 6419 6420 6421 6422 6423 6424 6425 6426 6427 6428 6429 6430
                            switch (op1) {
                            case 0:  /*  strex */
                                gen_st32(tmp, addr, IS_USER(s));
                                break;
                            case 1: /*  strexd */
                                gen_st32(tmp, addr, IS_USER(s));
                                tcg_gen_addi_i32(addr, addr, 4);
                                tmp = load_reg(s, rm + 1);
                                gen_st32(tmp, addr, IS_USER(s));
                                break;
                            case 2: /*  strexb */
                                gen_st8(tmp, addr, IS_USER(s));
                                break;
                            case 3: /* strexh */
                                gen_st16(tmp, addr, IS_USER(s));
                                break;
                            default:
                                abort();
                            }
B
balrog 已提交
6431
                            gen_set_label(label);
6432 6433
                            tcg_gen_mov_i32(cpu_R[rd], tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
6434
                        }
6435
                        tcg_temp_free(addr);
P
pbrook 已提交
6436 6437 6438 6439
                    } else {
                        /* SWP instruction */
                        rm = (insn) & 0xf;

P
pbrook 已提交
6440 6441 6442 6443 6444
                        /* ??? This is not really atomic.  However we know
                           we never have multiple CPUs running in parallel,
                           so it is good enough.  */
                        addr = load_reg(s, rn);
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6445
                        if (insn & (1 << 22)) {
P
pbrook 已提交
6446 6447
                            tmp2 = gen_ld8u(addr, IS_USER(s));
                            gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
6448
                        } else {
P
pbrook 已提交
6449 6450
                            tmp2 = gen_ld32(addr, IS_USER(s));
                            gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
6451
                        }
P
pbrook 已提交
6452 6453
                        dead_tmp(addr);
                        store_reg(s, rd, tmp2);
P
pbrook 已提交
6454 6455 6456 6457 6458 6459 6460 6461
                    }
                }
            } else {
                int address_offset;
                int load;
                /* Misc load/store */
                rn = (insn >> 16) & 0xf;
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6462
                addr = load_reg(s, rn);
P
pbrook 已提交
6463
                if (insn & (1 << 24))
P
pbrook 已提交
6464
                    gen_add_datah_offset(s, insn, 0, addr);
P
pbrook 已提交
6465 6466 6467 6468 6469
                address_offset = 0;
                if (insn & (1 << 20)) {
                    /* load */
                    switch(sh) {
                    case 1:
P
pbrook 已提交
6470
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
6471 6472
                        break;
                    case 2:
P
pbrook 已提交
6473
                        tmp = gen_ld8s(addr, IS_USER(s));
P
pbrook 已提交
6474 6475 6476
                        break;
                    default:
                    case 3:
P
pbrook 已提交
6477
                        tmp = gen_ld16s(addr, IS_USER(s));
P
pbrook 已提交
6478 6479 6480 6481 6482 6483 6484
                        break;
                    }
                    load = 1;
                } else if (sh & 2) {
                    /* doubleword */
                    if (sh & 1) {
                        /* store */
P
pbrook 已提交
6485 6486 6487 6488 6489
                        tmp = load_reg(s, rd);
                        gen_st32(tmp, addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, 4);
                        tmp = load_reg(s, rd + 1);
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
6490 6491 6492
                        load = 0;
                    } else {
                        /* load */
P
pbrook 已提交
6493 6494 6495 6496
                        tmp = gen_ld32(addr, IS_USER(s));
                        store_reg(s, rd, tmp);
                        tcg_gen_addi_i32(addr, addr, 4);
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
6497 6498 6499 6500 6501 6502
                        rd++;
                        load = 1;
                    }
                    address_offset = -4;
                } else {
                    /* store */
P
pbrook 已提交
6503 6504
                    tmp = load_reg(s, rd);
                    gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
6505 6506 6507 6508 6509 6510 6511
                    load = 0;
                }
                /* Perform base writeback before the loaded value to
                   ensure correct behavior with overlapping index registers.
                   ldrd with base writeback is is undefined if the
                   destination and index registers overlap.  */
                if (!(insn & (1 << 24))) {
P
pbrook 已提交
6512 6513
                    gen_add_datah_offset(s, insn, address_offset, addr);
                    store_reg(s, rn, addr);
P
pbrook 已提交
6514 6515
                } else if (insn & (1 << 21)) {
                    if (address_offset)
P
pbrook 已提交
6516 6517 6518 6519
                        tcg_gen_addi_i32(addr, addr, address_offset);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
6520 6521 6522
                }
                if (load) {
                    /* Complete the load.  */
P
pbrook 已提交
6523
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6524 6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536
                }
            }
            break;
        case 0x4:
        case 0x5:
            goto do_ldst;
        case 0x6:
        case 0x7:
            if (insn & (1 << 4)) {
                ARCH(6);
                /* Armv6 Media instructions.  */
                rm = insn & 0xf;
                rn = (insn >> 16) & 0xf;
B
bellard 已提交
6537
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6538 6539 6540 6541
                rs = (insn >> 8) & 0xf;
                switch ((insn >> 23) & 3) {
                case 0: /* Parallel add/subtract.  */
                    op1 = (insn >> 20) & 7;
P
pbrook 已提交
6542 6543
                    tmp = load_reg(s, rn);
                    tmp2 = load_reg(s, rm);
P
pbrook 已提交
6544 6545 6546
                    sh = (insn >> 5) & 7;
                    if ((op1 & 3) == 0 || sh == 5 || sh == 6)
                        goto illegal_op;
P
pbrook 已提交
6547 6548 6549
                    gen_arm_parallel_addsub(op1, sh, tmp, tmp2);
                    dead_tmp(tmp2);
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6550 6551 6552
                    break;
                case 1:
                    if ((insn & 0x00700020) == 0) {
B
balrog 已提交
6553
                        /* Halfword pack.  */
P
pbrook 已提交
6554 6555
                        tmp = load_reg(s, rn);
                        tmp2 = load_reg(s, rm);
P
pbrook 已提交
6556
                        shift = (insn >> 7) & 0x1f;
P
pbrook 已提交
6557 6558
                        if (insn & (1 << 6)) {
                            /* pkhtb */
6559 6560 6561
                            if (shift == 0)
                                shift = 31;
                            tcg_gen_sari_i32(tmp2, tmp2, shift);
P
pbrook 已提交
6562
                            tcg_gen_andi_i32(tmp, tmp, 0xffff0000);
P
pbrook 已提交
6563
                            tcg_gen_ext16u_i32(tmp2, tmp2);
P
pbrook 已提交
6564 6565
                        } else {
                            /* pkhbt */
6566 6567
                            if (shift)
                                tcg_gen_shli_i32(tmp2, tmp2, shift);
P
pbrook 已提交
6568
                            tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
6569 6570 6571
                            tcg_gen_andi_i32(tmp2, tmp2, 0xffff0000);
                        }
                        tcg_gen_or_i32(tmp, tmp, tmp2);
6572
                        dead_tmp(tmp2);
P
pbrook 已提交
6573
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6574 6575
                    } else if ((insn & 0x00200020) == 0x00200000) {
                        /* [us]sat */
P
pbrook 已提交
6576
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6577 6578 6579 6580
                        shift = (insn >> 7) & 0x1f;
                        if (insn & (1 << 6)) {
                            if (shift == 0)
                                shift = 31;
P
pbrook 已提交
6581
                            tcg_gen_sari_i32(tmp, tmp, shift);
P
pbrook 已提交
6582
                        } else {
P
pbrook 已提交
6583
                            tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
6584 6585 6586
                        }
                        sh = (insn >> 16) & 0x1f;
                        if (sh != 0) {
6587
                            tmp2 = tcg_const_i32(sh);
P
pbrook 已提交
6588
                            if (insn & (1 << 22))
6589
                                gen_helper_usat(tmp, tmp, tmp2);
P
pbrook 已提交
6590
                            else
6591 6592
                                gen_helper_ssat(tmp, tmp, tmp2);
                            tcg_temp_free_i32(tmp2);
P
pbrook 已提交
6593
                        }
P
pbrook 已提交
6594
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6595 6596
                    } else if ((insn & 0x00300fe0) == 0x00200f20) {
                        /* [us]sat16 */
P
pbrook 已提交
6597
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6598 6599
                        sh = (insn >> 16) & 0x1f;
                        if (sh != 0) {
6600
                            tmp2 = tcg_const_i32(sh);
P
pbrook 已提交
6601
                            if (insn & (1 << 22))
6602
                                gen_helper_usat16(tmp, tmp, tmp2);
P
pbrook 已提交
6603
                            else
6604 6605
                                gen_helper_ssat16(tmp, tmp, tmp2);
                            tcg_temp_free_i32(tmp2);
P
pbrook 已提交
6606
                        }
P
pbrook 已提交
6607
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6608 6609
                    } else if ((insn & 0x00700fe0) == 0x00000fa0) {
                        /* Select bytes.  */
P
pbrook 已提交
6610 6611 6612 6613 6614 6615 6616 6617
                        tmp = load_reg(s, rn);
                        tmp2 = load_reg(s, rm);
                        tmp3 = new_tmp();
                        tcg_gen_ld_i32(tmp3, cpu_env, offsetof(CPUState, GE));
                        gen_helper_sel_flags(tmp, tmp3, tmp, tmp2);
                        dead_tmp(tmp3);
                        dead_tmp(tmp2);
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6618
                    } else if ((insn & 0x000003e0) == 0x00000060) {
P
pbrook 已提交
6619
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6620 6621 6622 6623
                        shift = (insn >> 10) & 3;
                        /* ??? In many cases it's not neccessary to do a
                           rotate, a shift is sufficient.  */
                        if (shift != 0)
P
pbrook 已提交
6624
                            tcg_gen_rori_i32(tmp, tmp, shift * 8);
P
pbrook 已提交
6625 6626
                        op1 = (insn >> 20) & 7;
                        switch (op1) {
P
pbrook 已提交
6627 6628 6629 6630 6631 6632
                        case 0: gen_sxtb16(tmp);  break;
                        case 2: gen_sxtb(tmp);    break;
                        case 3: gen_sxth(tmp);    break;
                        case 4: gen_uxtb16(tmp);  break;
                        case 6: gen_uxtb(tmp);    break;
                        case 7: gen_uxth(tmp);    break;
P
pbrook 已提交
6633 6634 6635
                        default: goto illegal_op;
                        }
                        if (rn != 15) {
P
pbrook 已提交
6636
                            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6637
                            if ((op1 & 3) == 0) {
P
pbrook 已提交
6638
                                gen_add16(tmp, tmp2);
P
pbrook 已提交
6639
                            } else {
P
pbrook 已提交
6640 6641
                                tcg_gen_add_i32(tmp, tmp, tmp2);
                                dead_tmp(tmp2);
P
pbrook 已提交
6642 6643
                            }
                        }
B
balrog 已提交
6644
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6645 6646
                    } else if ((insn & 0x003f0f60) == 0x003f0f20) {
                        /* rev */
P
pbrook 已提交
6647
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6648 6649
                        if (insn & (1 << 22)) {
                            if (insn & (1 << 7)) {
P
pbrook 已提交
6650
                                gen_revsh(tmp);
P
pbrook 已提交
6651 6652
                            } else {
                                ARCH(6T2);
P
pbrook 已提交
6653
                                gen_helper_rbit(tmp, tmp);
P
pbrook 已提交
6654 6655 6656
                            }
                        } else {
                            if (insn & (1 << 7))
P
pbrook 已提交
6657
                                gen_rev16(tmp);
P
pbrook 已提交
6658
                            else
A
aurel32 已提交
6659
                                tcg_gen_bswap32_i32(tmp, tmp);
P
pbrook 已提交
6660
                        }
P
pbrook 已提交
6661
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6662 6663 6664 6665 6666
                    } else {
                        goto illegal_op;
                    }
                    break;
                case 2: /* Multiplies (Type 3).  */
P
pbrook 已提交
6667 6668
                    tmp = load_reg(s, rm);
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
6669 6670
                    if (insn & (1 << 20)) {
                        /* Signed multiply most significant [accumulate].  */
P
pbrook 已提交
6671
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
6672
                        if (insn & (1 << 5))
P
pbrook 已提交
6673 6674
                            tcg_gen_addi_i64(tmp64, tmp64, 0x80000000u);
                        tcg_gen_shri_i64(tmp64, tmp64, 32);
P
pbrook 已提交
6675
                        tmp = new_tmp();
P
pbrook 已提交
6676
                        tcg_gen_trunc_i64_i32(tmp, tmp64);
6677
                        tcg_temp_free_i64(tmp64);
6678 6679
                        if (rd != 15) {
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6680
                            if (insn & (1 << 6)) {
P
pbrook 已提交
6681
                                tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
6682
                            } else {
P
pbrook 已提交
6683
                                tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
6684
                            }
P
pbrook 已提交
6685
                            dead_tmp(tmp2);
P
pbrook 已提交
6686
                        }
6687
                        store_reg(s, rn, tmp);
P
pbrook 已提交
6688 6689
                    } else {
                        if (insn & (1 << 5))
P
pbrook 已提交
6690 6691 6692 6693 6694 6695 6696 6697 6698
                            gen_swap_half(tmp2);
                        gen_smul_dual(tmp, tmp2);
                        /* This addition cannot overflow.  */
                        if (insn & (1 << 6)) {
                            tcg_gen_sub_i32(tmp, tmp, tmp2);
                        } else {
                            tcg_gen_add_i32(tmp, tmp, tmp2);
                        }
                        dead_tmp(tmp2);
P
pbrook 已提交
6699
                        if (insn & (1 << 22)) {
P
pbrook 已提交
6700
                            /* smlald, smlsld */
P
pbrook 已提交
6701 6702
                            tmp64 = tcg_temp_new_i64();
                            tcg_gen_ext_i32_i64(tmp64, tmp);
P
pbrook 已提交
6703
                            dead_tmp(tmp);
P
pbrook 已提交
6704 6705
                            gen_addq(s, tmp64, rd, rn);
                            gen_storeq_reg(s, rd, rn, tmp64);
6706
                            tcg_temp_free_i64(tmp64);
P
pbrook 已提交
6707
                        } else {
P
pbrook 已提交
6708
                            /* smuad, smusd, smlad, smlsd */
6709
                            if (rd != 15)
P
pbrook 已提交
6710
                              {
6711
                                tmp2 = load_reg(s, rd);
P
pbrook 已提交
6712 6713
                                gen_helper_add_setq(tmp, tmp, tmp2);
                                dead_tmp(tmp2);
P
pbrook 已提交
6714
                              }
6715
                            store_reg(s, rn, tmp);
P
pbrook 已提交
6716 6717 6718 6719 6720 6721 6722
                        }
                    }
                    break;
                case 3:
                    op1 = ((insn >> 17) & 0x38) | ((insn >> 5) & 7);
                    switch (op1) {
                    case 0: /* Unsigned sum of absolute differences.  */
P
pbrook 已提交
6723 6724 6725 6726 6727
                        ARCH(6);
                        tmp = load_reg(s, rm);
                        tmp2 = load_reg(s, rs);
                        gen_helper_usad8(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
6728 6729
                        if (rd != 15) {
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6730 6731
                            tcg_gen_add_i32(tmp, tmp, tmp2);
                            dead_tmp(tmp2);
P
pbrook 已提交
6732
                        }
6733
                        store_reg(s, rn, tmp);
P
pbrook 已提交
6734 6735 6736 6737 6738 6739 6740 6741
                        break;
                    case 0x20: case 0x24: case 0x28: case 0x2c:
                        /* Bitfield insert/clear.  */
                        ARCH(6T2);
                        shift = (insn >> 7) & 0x1f;
                        i = (insn >> 16) & 0x1f;
                        i = i + 1 - shift;
                        if (rm == 15) {
P
pbrook 已提交
6742 6743
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
6744
                        } else {
P
pbrook 已提交
6745
                            tmp = load_reg(s, rm);
P
pbrook 已提交
6746 6747
                        }
                        if (i != 32) {
P
pbrook 已提交
6748
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6749
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << i) - 1);
P
pbrook 已提交
6750
                            dead_tmp(tmp2);
P
pbrook 已提交
6751
                        }
P
pbrook 已提交
6752
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6753 6754 6755
                        break;
                    case 0x12: case 0x16: case 0x1a: case 0x1e: /* sbfx */
                    case 0x32: case 0x36: case 0x3a: case 0x3e: /* ubfx */
6756
                        ARCH(6T2);
P
pbrook 已提交
6757
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6758 6759 6760 6761 6762 6763
                        shift = (insn >> 7) & 0x1f;
                        i = ((insn >> 16) & 0x1f) + 1;
                        if (shift + i > 32)
                            goto illegal_op;
                        if (i < 32) {
                            if (op1 & 0x20) {
P
pbrook 已提交
6764
                                gen_ubfx(tmp, shift, (1u << i) - 1);
P
pbrook 已提交
6765
                            } else {
P
pbrook 已提交
6766
                                gen_sbfx(tmp, shift, i);
P
pbrook 已提交
6767 6768
                            }
                        }
P
pbrook 已提交
6769
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6770 6771 6772 6773 6774 6775 6776 6777 6778 6779 6780 6781 6782 6783 6784 6785 6786 6787 6788 6789 6790
                        break;
                    default:
                        goto illegal_op;
                    }
                    break;
                }
                break;
            }
        do_ldst:
            /* Check for undefined extension instructions
             * per the ARM Bible IE:
             * xxxx 0111 1111 xxxx  xxxx xxxx 1111 xxxx
             */
            sh = (0xf << 20) | (0xf << 4);
            if (op1 == 0x7 && ((insn & sh) == sh))
            {
                goto illegal_op;
            }
            /* load/store byte/word */
            rn = (insn >> 16) & 0xf;
            rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6791
            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6792 6793
            i = (IS_USER(s) || (insn & 0x01200000) == 0x00200000);
            if (insn & (1 << 24))
P
pbrook 已提交
6794
                gen_add_data_offset(s, insn, tmp2);
P
pbrook 已提交
6795 6796 6797
            if (insn & (1 << 20)) {
                /* load */
                if (insn & (1 << 22)) {
P
pbrook 已提交
6798
                    tmp = gen_ld8u(tmp2, i);
P
pbrook 已提交
6799
                } else {
P
pbrook 已提交
6800
                    tmp = gen_ld32(tmp2, i);
P
pbrook 已提交
6801 6802 6803
                }
            } else {
                /* store */
P
pbrook 已提交
6804
                tmp = load_reg(s, rd);
P
pbrook 已提交
6805
                if (insn & (1 << 22))
P
pbrook 已提交
6806
                    gen_st8(tmp, tmp2, i);
P
pbrook 已提交
6807
                else
P
pbrook 已提交
6808
                    gen_st32(tmp, tmp2, i);
P
pbrook 已提交
6809 6810
            }
            if (!(insn & (1 << 24))) {
P
pbrook 已提交
6811 6812 6813 6814 6815 6816
                gen_add_data_offset(s, insn, tmp2);
                store_reg(s, rn, tmp2);
            } else if (insn & (1 << 21)) {
                store_reg(s, rn, tmp2);
            } else {
                dead_tmp(tmp2);
P
pbrook 已提交
6817 6818 6819 6820
            }
            if (insn & (1 << 20)) {
                /* Complete the load.  */
                if (rd == 15)
P
pbrook 已提交
6821
                    gen_bx(s, tmp);
P
pbrook 已提交
6822
                else
P
pbrook 已提交
6823
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6824 6825 6826 6827 6828 6829
            }
            break;
        case 0x08:
        case 0x09:
            {
                int j, n, user, loaded_base;
P
pbrook 已提交
6830
                TCGv loaded_var;
P
pbrook 已提交
6831 6832 6833 6834 6835 6836 6837 6838 6839 6840 6841
                /* load/store multiple words */
                /* XXX: store correct base if write back */
                user = 0;
                if (insn & (1 << 22)) {
                    if (IS_USER(s))
                        goto illegal_op; /* only usable in supervisor mode */

                    if ((insn & (1 << 15)) == 0)
                        user = 1;
                }
                rn = (insn >> 16) & 0xf;
P
pbrook 已提交
6842
                addr = load_reg(s, rn);
P
pbrook 已提交
6843 6844 6845

                /* compute total size */
                loaded_base = 0;
P
pbrook 已提交
6846
                TCGV_UNUSED(loaded_var);
P
pbrook 已提交
6847 6848 6849 6850 6851 6852 6853 6854 6855
                n = 0;
                for(i=0;i<16;i++) {
                    if (insn & (1 << i))
                        n++;
                }
                /* XXX: test invalid n == 0 case ? */
                if (insn & (1 << 23)) {
                    if (insn & (1 << 24)) {
                        /* pre increment */
P
pbrook 已提交
6856
                        tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6857 6858 6859 6860 6861 6862
                    } else {
                        /* post increment */
                    }
                } else {
                    if (insn & (1 << 24)) {
                        /* pre decrement */
P
pbrook 已提交
6863
                        tcg_gen_addi_i32(addr, addr, -(n * 4));
P
pbrook 已提交
6864 6865 6866
                    } else {
                        /* post decrement */
                        if (n != 1)
P
pbrook 已提交
6867
                        tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
P
pbrook 已提交
6868 6869 6870 6871 6872 6873 6874
                    }
                }
                j = 0;
                for(i=0;i<16;i++) {
                    if (insn & (1 << i)) {
                        if (insn & (1 << 20)) {
                            /* load */
P
pbrook 已提交
6875
                            tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
6876
                            if (i == 15) {
P
pbrook 已提交
6877
                                gen_bx(s, tmp);
P
pbrook 已提交
6878
                            } else if (user) {
6879 6880 6881
                                tmp2 = tcg_const_i32(i);
                                gen_helper_set_user_reg(tmp2, tmp);
                                tcg_temp_free_i32(tmp2);
P
pbrook 已提交
6882
                                dead_tmp(tmp);
P
pbrook 已提交
6883
                            } else if (i == rn) {
P
pbrook 已提交
6884
                                loaded_var = tmp;
P
pbrook 已提交
6885 6886
                                loaded_base = 1;
                            } else {
P
pbrook 已提交
6887
                                store_reg(s, i, tmp);
P
pbrook 已提交
6888 6889 6890 6891 6892 6893
                            }
                        } else {
                            /* store */
                            if (i == 15) {
                                /* special case: r15 = PC + 8 */
                                val = (long)s->pc + 4;
P
pbrook 已提交
6894 6895
                                tmp = new_tmp();
                                tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
6896
                            } else if (user) {
P
pbrook 已提交
6897
                                tmp = new_tmp();
6898 6899 6900
                                tmp2 = tcg_const_i32(i);
                                gen_helper_get_user_reg(tmp, tmp2);
                                tcg_temp_free_i32(tmp2);
P
pbrook 已提交
6901
                            } else {
P
pbrook 已提交
6902
                                tmp = load_reg(s, i);
P
pbrook 已提交
6903
                            }
P
pbrook 已提交
6904
                            gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
6905 6906 6907 6908
                        }
                        j++;
                        /* no need to add after the last transfer */
                        if (j != n)
P
pbrook 已提交
6909
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6910 6911 6912 6913 6914 6915 6916 6917 6918
                    }
                }
                if (insn & (1 << 21)) {
                    /* write back */
                    if (insn & (1 << 23)) {
                        if (insn & (1 << 24)) {
                            /* pre increment */
                        } else {
                            /* post increment */
P
pbrook 已提交
6919
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6920 6921 6922 6923 6924
                        }
                    } else {
                        if (insn & (1 << 24)) {
                            /* pre decrement */
                            if (n != 1)
P
pbrook 已提交
6925
                                tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
P
pbrook 已提交
6926 6927
                        } else {
                            /* post decrement */
P
pbrook 已提交
6928
                            tcg_gen_addi_i32(addr, addr, -(n * 4));
P
pbrook 已提交
6929 6930
                        }
                    }
P
pbrook 已提交
6931 6932 6933
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
6934 6935
                }
                if (loaded_base) {
P
pbrook 已提交
6936
                    store_reg(s, rn, loaded_var);
P
pbrook 已提交
6937 6938 6939
                }
                if ((insn & (1 << 22)) && !user) {
                    /* Restore CPSR from SPSR.  */
P
pbrook 已提交
6940 6941 6942
                    tmp = load_cpu_field(spsr);
                    gen_set_cpsr(tmp, 0xffffffff);
                    dead_tmp(tmp);
P
pbrook 已提交
6943 6944 6945 6946 6947 6948 6949 6950 6951 6952 6953 6954
                    s->is_jmp = DISAS_UPDATE;
                }
            }
            break;
        case 0xa:
        case 0xb:
            {
                int32_t offset;

                /* branch (and link) */
                val = (int32_t)s->pc;
                if (insn & (1 << 24)) {
P
pbrook 已提交
6955 6956 6957
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, val);
                    store_reg(s, 14, tmp);
P
pbrook 已提交
6958 6959 6960 6961 6962 6963 6964 6965 6966 6967 6968 6969 6970 6971 6972
                }
                offset = (((int32_t)insn << 8) >> 8);
                val += (offset << 2) + 4;
                gen_jmp(s, val);
            }
            break;
        case 0xc:
        case 0xd:
        case 0xe:
            /* Coprocessor.  */
            if (disas_coproc_insn(env, s, insn))
                goto illegal_op;
            break;
        case 0xf:
            /* swi */
P
pbrook 已提交
6973
            gen_set_pc_im(s->pc);
P
pbrook 已提交
6974 6975 6976 6977 6978
            s->is_jmp = DISAS_SWI;
            break;
        default:
        illegal_op:
            gen_set_condexec(s);
P
pbrook 已提交
6979
            gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
6980
            gen_exception(EXCP_UDEF);
P
pbrook 已提交
6981 6982 6983 6984 6985 6986 6987 6988 6989 6990 6991 6992 6993 6994 6995 6996 6997 6998 6999 7000
            s->is_jmp = DISAS_JUMP;
            break;
        }
    }
}

/* Return true if this is a Thumb-2 logical op.  */
static int
thumb2_logic_op(int op)
{
    return (op < 8);
}

/* Generate code for a Thumb-2 data processing operation.  If CONDS is nonzero
   then set condition code flags based on the result of the operation.
   If SHIFTER_OUT is nonzero then set the carry flag for logical operations
   to the high bit of T1.
   Returns zero if the opcode is valid.  */

static int
7001
gen_thumb2_data_op(DisasContext *s, int op, int conds, uint32_t shifter_out, TCGv t0, TCGv t1)
P
pbrook 已提交
7002 7003 7004 7005 7006 7007
{
    int logic_cc;

    logic_cc = 0;
    switch (op) {
    case 0: /* and */
7008
        tcg_gen_and_i32(t0, t0, t1);
P
pbrook 已提交
7009 7010 7011
        logic_cc = conds;
        break;
    case 1: /* bic */
7012
        tcg_gen_bic_i32(t0, t0, t1);
P
pbrook 已提交
7013 7014 7015
        logic_cc = conds;
        break;
    case 2: /* orr */
7016
        tcg_gen_or_i32(t0, t0, t1);
P
pbrook 已提交
7017 7018 7019
        logic_cc = conds;
        break;
    case 3: /* orn */
7020 7021
        tcg_gen_not_i32(t1, t1);
        tcg_gen_or_i32(t0, t0, t1);
P
pbrook 已提交
7022 7023 7024
        logic_cc = conds;
        break;
    case 4: /* eor */
7025
        tcg_gen_xor_i32(t0, t0, t1);
P
pbrook 已提交
7026 7027 7028 7029
        logic_cc = conds;
        break;
    case 8: /* add */
        if (conds)
7030
            gen_helper_add_cc(t0, t0, t1);
P
pbrook 已提交
7031
        else
7032
            tcg_gen_add_i32(t0, t0, t1);
P
pbrook 已提交
7033 7034 7035
        break;
    case 10: /* adc */
        if (conds)
7036
            gen_helper_adc_cc(t0, t0, t1);
P
pbrook 已提交
7037
        else
7038
            gen_adc(t0, t1);
P
pbrook 已提交
7039 7040 7041
        break;
    case 11: /* sbc */
        if (conds)
7042
            gen_helper_sbc_cc(t0, t0, t1);
P
pbrook 已提交
7043
        else
7044
            gen_sub_carry(t0, t0, t1);
P
pbrook 已提交
7045 7046 7047
        break;
    case 13: /* sub */
        if (conds)
7048
            gen_helper_sub_cc(t0, t0, t1);
P
pbrook 已提交
7049
        else
7050
            tcg_gen_sub_i32(t0, t0, t1);
P
pbrook 已提交
7051 7052 7053
        break;
    case 14: /* rsb */
        if (conds)
7054
            gen_helper_sub_cc(t0, t1, t0);
P
pbrook 已提交
7055
        else
7056
            tcg_gen_sub_i32(t0, t1, t0);
P
pbrook 已提交
7057 7058 7059 7060 7061
        break;
    default: /* 5, 6, 7, 9, 12, 15. */
        return 1;
    }
    if (logic_cc) {
7062
        gen_logic_CC(t0);
P
pbrook 已提交
7063
        if (shifter_out)
7064
            gen_set_CF_bit31(t1);
P
pbrook 已提交
7065 7066 7067 7068 7069 7070 7071 7072
    }
    return 0;
}

/* Translate a 32-bit thumb instruction.  Returns nonzero if the instruction
   is not legal.  */
static int disas_thumb2_insn(CPUState *env, DisasContext *s, uint16_t insn_hw1)
{
P
pbrook 已提交
7073
    uint32_t insn, imm, shift, offset;
P
pbrook 已提交
7074
    uint32_t rd, rn, rm, rs;
P
pbrook 已提交
7075
    TCGv tmp;
P
pbrook 已提交
7076 7077
    TCGv tmp2;
    TCGv tmp3;
P
pbrook 已提交
7078
    TCGv addr;
P
pbrook 已提交
7079
    TCGv_i64 tmp64;
P
pbrook 已提交
7080 7081 7082 7083 7084 7085 7086
    int op;
    int shiftop;
    int conds;
    int logic_cc;

    if (!(arm_feature(env, ARM_FEATURE_THUMB2)
          || arm_feature (env, ARM_FEATURE_M))) {
7087
        /* Thumb-1 cores may need to treat bl and blx as a pair of
P
pbrook 已提交
7088 7089 7090 7091 7092
           16-bit instructions to get correct prefetch abort behavior.  */
        insn = insn_hw1;
        if ((insn & (1 << 12)) == 0) {
            /* Second half of blx.  */
            offset = ((insn & 0x7ff) << 1);
P
pbrook 已提交
7093 7094 7095
            tmp = load_reg(s, 14);
            tcg_gen_addi_i32(tmp, tmp, offset);
            tcg_gen_andi_i32(tmp, tmp, 0xfffffffc);
P
pbrook 已提交
7096

P
pbrook 已提交
7097
            tmp2 = new_tmp();
P
pbrook 已提交
7098
            tcg_gen_movi_i32(tmp2, s->pc | 1);
P
pbrook 已提交
7099 7100
            store_reg(s, 14, tmp2);
            gen_bx(s, tmp);
P
pbrook 已提交
7101 7102 7103 7104 7105
            return 0;
        }
        if (insn & (1 << 11)) {
            /* Second half of bl.  */
            offset = ((insn & 0x7ff) << 1) | 1;
P
pbrook 已提交
7106
            tmp = load_reg(s, 14);
B
balrog 已提交
7107
            tcg_gen_addi_i32(tmp, tmp, offset);
P
pbrook 已提交
7108

P
pbrook 已提交
7109
            tmp2 = new_tmp();
P
pbrook 已提交
7110
            tcg_gen_movi_i32(tmp2, s->pc | 1);
P
pbrook 已提交
7111 7112
            store_reg(s, 14, tmp2);
            gen_bx(s, tmp);
P
pbrook 已提交
7113 7114 7115 7116 7117 7118 7119
            return 0;
        }
        if ((s->pc & ~TARGET_PAGE_MASK) == 0) {
            /* Instruction spans a page boundary.  Implement it as two
               16-bit instructions in case the second half causes an
               prefetch abort.  */
            offset = ((int32_t)insn << 21) >> 9;
7120
            tcg_gen_movi_i32(cpu_R[14], s->pc + 2 + offset);
P
pbrook 已提交
7121 7122 7123 7124 7125 7126 7127 7128 7129 7130 7131 7132 7133 7134 7135 7136 7137 7138 7139 7140 7141 7142 7143 7144 7145 7146 7147
            return 0;
        }
        /* Fall through to 32-bit decode.  */
    }

    insn = lduw_code(s->pc);
    s->pc += 2;
    insn |= (uint32_t)insn_hw1 << 16;

    if ((insn & 0xf800e800) != 0xf000e800) {
        ARCH(6T2);
    }

    rn = (insn >> 16) & 0xf;
    rs = (insn >> 12) & 0xf;
    rd = (insn >> 8) & 0xf;
    rm = insn & 0xf;
    switch ((insn >> 25) & 0xf) {
    case 0: case 1: case 2: case 3:
        /* 16-bit instructions.  Should never happen.  */
        abort();
    case 4:
        if (insn & (1 << 22)) {
            /* Other load/store, table branch.  */
            if (insn & 0x01200000) {
                /* Load/store doubleword.  */
                if (rn == 15) {
P
pbrook 已提交
7148 7149
                    addr = new_tmp();
                    tcg_gen_movi_i32(addr, s->pc & ~3);
P
pbrook 已提交
7150
                } else {
P
pbrook 已提交
7151
                    addr = load_reg(s, rn);
P
pbrook 已提交
7152 7153 7154 7155 7156
                }
                offset = (insn & 0xff) * 4;
                if ((insn & (1 << 23)) == 0)
                    offset = -offset;
                if (insn & (1 << 24)) {
P
pbrook 已提交
7157
                    tcg_gen_addi_i32(addr, addr, offset);
P
pbrook 已提交
7158 7159 7160 7161
                    offset = 0;
                }
                if (insn & (1 << 20)) {
                    /* ldrd */
P
pbrook 已提交
7162 7163 7164 7165 7166
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, rs, tmp);
                    tcg_gen_addi_i32(addr, addr, 4);
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7167 7168
                } else {
                    /* strd */
P
pbrook 已提交
7169 7170 7171 7172 7173
                    tmp = load_reg(s, rs);
                    gen_st32(tmp, addr, IS_USER(s));
                    tcg_gen_addi_i32(addr, addr, 4);
                    tmp = load_reg(s, rd);
                    gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
7174 7175 7176 7177 7178
                }
                if (insn & (1 << 21)) {
                    /* Base writeback.  */
                    if (rn == 15)
                        goto illegal_op;
P
pbrook 已提交
7179 7180 7181 7182
                    tcg_gen_addi_i32(addr, addr, offset - 4);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
7183 7184 7185
                }
            } else if ((insn & (1 << 23)) == 0) {
                /* Load/store exclusive word.  */
7186
                addr = tcg_temp_local_new();
7187
                load_reg_var(s, addr, rn);
B
bellard 已提交
7188
                if (insn & (1 << 20)) {
7189
                    gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
7190 7191
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7192
                } else {
P
pbrook 已提交
7193
                    int label = gen_new_label();
7194 7195 7196
                    tmp2 = tcg_temp_local_new();
                    gen_helper_test_exclusive(tmp2, cpu_env, addr);
                    tcg_gen_brcondi_i32(TCG_COND_NE, tmp2, 0, label);
P
pbrook 已提交
7197
                    tmp = load_reg(s, rs);
7198
                    gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
7199
                    gen_set_label(label);
7200 7201
                    tcg_gen_mov_i32(cpu_R[rd], tmp2);
                    tcg_temp_free(tmp2);
P
pbrook 已提交
7202
                }
7203
                tcg_temp_free(addr);
P
pbrook 已提交
7204 7205 7206
            } else if ((insn & (1 << 6)) == 0) {
                /* Table Branch.  */
                if (rn == 15) {
P
pbrook 已提交
7207 7208
                    addr = new_tmp();
                    tcg_gen_movi_i32(addr, s->pc);
P
pbrook 已提交
7209
                } else {
P
pbrook 已提交
7210
                    addr = load_reg(s, rn);
P
pbrook 已提交
7211
                }
P
pbrook 已提交
7212
                tmp = load_reg(s, rm);
P
pbrook 已提交
7213
                tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
7214 7215
                if (insn & (1 << 4)) {
                    /* tbh */
P
pbrook 已提交
7216
                    tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
7217
                    dead_tmp(tmp);
P
pbrook 已提交
7218
                    tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
7219
                } else { /* tbb */
P
pbrook 已提交
7220
                    dead_tmp(tmp);
P
pbrook 已提交
7221
                    tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
7222
                }
P
pbrook 已提交
7223 7224 7225 7226
                dead_tmp(addr);
                tcg_gen_shli_i32(tmp, tmp, 1);
                tcg_gen_addi_i32(tmp, tmp, s->pc);
                store_reg(s, 15, tmp);
P
pbrook 已提交
7227 7228
            } else {
                /* Load/store exclusive byte/halfword/doubleword.  */
P
pbrook 已提交
7229 7230 7231
                /* ??? These are not really atomic.  However we know
                   we never have multiple CPUs running in parallel,
                   so it is good enough.  */
P
pbrook 已提交
7232
                op = (insn >> 4) & 0x3;
7233
                addr = tcg_temp_local_new();
7234
                load_reg_var(s, addr, rn);
P
pbrook 已提交
7235
                if (insn & (1 << 20)) {
P
pbrook 已提交
7236
                    gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
7237 7238
                    switch (op) {
                    case 0:
P
pbrook 已提交
7239
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
7240
                        break;
B
bellard 已提交
7241
                    case 1:
P
pbrook 已提交
7242
                        tmp = gen_ld16u(addr, IS_USER(s));
B
bellard 已提交
7243
                        break;
P
pbrook 已提交
7244
                    case 3:
P
pbrook 已提交
7245 7246 7247 7248
                        tmp = gen_ld32(addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, 4);
                        tmp2 = gen_ld32(addr, IS_USER(s));
                        store_reg(s, rd, tmp2);
B
bellard 已提交
7249 7250
                        break;
                    default:
P
pbrook 已提交
7251 7252
                        goto illegal_op;
                    }
P
pbrook 已提交
7253
                    store_reg(s, rs, tmp);
P
pbrook 已提交
7254
                } else {
P
pbrook 已提交
7255
                    int label = gen_new_label();
7256 7257 7258
                    tmp2 = tcg_temp_local_new();
                    gen_helper_test_exclusive(tmp2, cpu_env, addr);
                    tcg_gen_brcondi_i32(TCG_COND_NE, tmp2, 0, label);
P
pbrook 已提交
7259
                    tmp = load_reg(s, rs);
P
pbrook 已提交
7260 7261
                    switch (op) {
                    case 0:
P
pbrook 已提交
7262
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
7263 7264
                        break;
                    case 1:
P
pbrook 已提交
7265
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
7266
                        break;
B
bellard 已提交
7267
                    case 3:
P
pbrook 已提交
7268 7269 7270 7271
                        gen_st32(tmp, addr, IS_USER(s));
                        tcg_gen_addi_i32(addr, addr, 4);
                        tmp = load_reg(s, rd);
                        gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
7272
                        break;
P
pbrook 已提交
7273 7274
                    default:
                        goto illegal_op;
B
bellard 已提交
7275
                    }
P
pbrook 已提交
7276
                    gen_set_label(label);
7277 7278
                    tcg_gen_mov_i32(cpu_R[rm], tmp2);
                    tcg_temp_free(tmp2);
P
pbrook 已提交
7279
                }
7280
                tcg_temp_free(addr);
P
pbrook 已提交
7281 7282 7283 7284 7285
            }
        } else {
            /* Load/store multiple, RFE, SRS.  */
            if (((insn >> 23) & 1) == ((insn >> 24) & 1)) {
                /* Not available in user mode.  */
P
pbrook 已提交
7286
                if (IS_USER(s))
P
pbrook 已提交
7287 7288 7289
                    goto illegal_op;
                if (insn & (1 << 20)) {
                    /* rfe */
P
pbrook 已提交
7290 7291 7292 7293 7294 7295 7296
                    addr = load_reg(s, rn);
                    if ((insn & (1 << 24)) == 0)
                        tcg_gen_addi_i32(addr, addr, -8);
                    /* Load PC into tmp and CPSR into tmp2.  */
                    tmp = gen_ld32(addr, 0);
                    tcg_gen_addi_i32(addr, addr, 4);
                    tmp2 = gen_ld32(addr, 0);
P
pbrook 已提交
7297 7298
                    if (insn & (1 << 21)) {
                        /* Base writeback.  */
P
pbrook 已提交
7299 7300 7301 7302 7303 7304 7305 7306
                        if (insn & (1 << 24)) {
                            tcg_gen_addi_i32(addr, addr, 4);
                        } else {
                            tcg_gen_addi_i32(addr, addr, -4);
                        }
                        store_reg(s, rn, addr);
                    } else {
                        dead_tmp(addr);
P
pbrook 已提交
7307
                    }
P
pbrook 已提交
7308
                    gen_rfe(s, tmp, tmp2);
P
pbrook 已提交
7309 7310 7311 7312
                } else {
                    /* srs */
                    op = (insn & 0x1f);
                    if (op == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
7313
                        addr = load_reg(s, 13);
P
pbrook 已提交
7314
                    } else {
P
pbrook 已提交
7315
                        addr = new_tmp();
7316 7317 7318
                        tmp = tcg_const_i32(op);
                        gen_helper_get_r13_banked(addr, cpu_env, tmp);
                        tcg_temp_free_i32(tmp);
P
pbrook 已提交
7319 7320
                    }
                    if ((insn & (1 << 24)) == 0) {
P
pbrook 已提交
7321
                        tcg_gen_addi_i32(addr, addr, -8);
P
pbrook 已提交
7322
                    }
P
pbrook 已提交
7323 7324 7325 7326 7327 7328
                    tmp = load_reg(s, 14);
                    gen_st32(tmp, addr, 0);
                    tcg_gen_addi_i32(addr, addr, 4);
                    tmp = new_tmp();
                    gen_helper_cpsr_read(tmp);
                    gen_st32(tmp, addr, 0);
P
pbrook 已提交
7329 7330
                    if (insn & (1 << 21)) {
                        if ((insn & (1 << 24)) == 0) {
P
pbrook 已提交
7331
                            tcg_gen_addi_i32(addr, addr, -4);
P
pbrook 已提交
7332
                        } else {
P
pbrook 已提交
7333
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
7334 7335
                        }
                        if (op == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
7336
                            store_reg(s, 13, addr);
P
pbrook 已提交
7337
                        } else {
7338 7339 7340
                            tmp = tcg_const_i32(op);
                            gen_helper_set_r13_banked(cpu_env, tmp, addr);
                            tcg_temp_free_i32(tmp);
P
pbrook 已提交
7341
                        }
P
pbrook 已提交
7342 7343
                    } else {
                        dead_tmp(addr);
P
pbrook 已提交
7344 7345 7346 7347 7348
                    }
                }
            } else {
                int i;
                /* Load/store multiple.  */
P
pbrook 已提交
7349
                addr = load_reg(s, rn);
P
pbrook 已提交
7350 7351 7352 7353 7354 7355
                offset = 0;
                for (i = 0; i < 16; i++) {
                    if (insn & (1 << i))
                        offset += 4;
                }
                if (insn & (1 << 24)) {
P
pbrook 已提交
7356
                    tcg_gen_addi_i32(addr, addr, -offset);
P
pbrook 已提交
7357 7358 7359 7360 7361 7362 7363
                }

                for (i = 0; i < 16; i++) {
                    if ((insn & (1 << i)) == 0)
                        continue;
                    if (insn & (1 << 20)) {
                        /* Load.  */
P
pbrook 已提交
7364
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
7365
                        if (i == 15) {
P
pbrook 已提交
7366
                            gen_bx(s, tmp);
P
pbrook 已提交
7367
                        } else {
P
pbrook 已提交
7368
                            store_reg(s, i, tmp);
P
pbrook 已提交
7369 7370 7371
                        }
                    } else {
                        /* Store.  */
P
pbrook 已提交
7372 7373
                        tmp = load_reg(s, i);
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
7374
                    }
P
pbrook 已提交
7375
                    tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
7376 7377 7378 7379
                }
                if (insn & (1 << 21)) {
                    /* Base register writeback.  */
                    if (insn & (1 << 24)) {
P
pbrook 已提交
7380
                        tcg_gen_addi_i32(addr, addr, -offset);
P
pbrook 已提交
7381 7382 7383 7384
                    }
                    /* Fault if writeback register is in register list.  */
                    if (insn & (1 << rn))
                        goto illegal_op;
P
pbrook 已提交
7385 7386 7387
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
7388 7389 7390 7391 7392
                }
            }
        }
        break;
    case 5: /* Data processing register constant shift.  */
7393 7394 7395 7396 7397 7398 7399
        if (rn == 15) {
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, 0);
        } else {
            tmp = load_reg(s, rn);
        }
        tmp2 = load_reg(s, rm);
P
pbrook 已提交
7400 7401 7402 7403 7404
        op = (insn >> 21) & 0xf;
        shiftop = (insn >> 4) & 3;
        shift = ((insn >> 6) & 3) | ((insn >> 10) & 0x1c);
        conds = (insn & (1 << 20)) != 0;
        logic_cc = (conds && thumb2_logic_op(op));
7405 7406
        gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
        if (gen_thumb2_data_op(s, op, conds, 0, tmp, tmp2))
P
pbrook 已提交
7407
            goto illegal_op;
7408 7409 7410 7411 7412 7413
        dead_tmp(tmp2);
        if (rd != 15) {
            store_reg(s, rd, tmp);
        } else {
            dead_tmp(tmp);
        }
P
pbrook 已提交
7414 7415 7416 7417 7418 7419 7420
        break;
    case 13: /* Misc data processing.  */
        op = ((insn >> 22) & 6) | ((insn >> 7) & 1);
        if (op < 4 && (insn & 0xf000) != 0xf000)
            goto illegal_op;
        switch (op) {
        case 0: /* Register controlled shift.  */
P
pbrook 已提交
7421 7422
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7423 7424 7425
            if ((insn & 0x70) != 0)
                goto illegal_op;
            op = (insn >> 21) & 3;
P
pbrook 已提交
7426 7427 7428 7429
            logic_cc = (insn & (1 << 20)) != 0;
            gen_arm_shift_reg(tmp, op, tmp2, logic_cc);
            if (logic_cc)
                gen_logic_CC(tmp);
7430
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
7431 7432
            break;
        case 1: /* Sign/zero extend.  */
P
pbrook 已提交
7433
            tmp = load_reg(s, rm);
P
pbrook 已提交
7434 7435 7436 7437
            shift = (insn >> 4) & 3;
            /* ??? In many cases it's not neccessary to do a
               rotate, a shift is sufficient.  */
            if (shift != 0)
P
pbrook 已提交
7438
                tcg_gen_rori_i32(tmp, tmp, shift * 8);
P
pbrook 已提交
7439 7440
            op = (insn >> 20) & 7;
            switch (op) {
P
pbrook 已提交
7441 7442 7443 7444 7445 7446
            case 0: gen_sxth(tmp);   break;
            case 1: gen_uxth(tmp);   break;
            case 2: gen_sxtb16(tmp); break;
            case 3: gen_uxtb16(tmp); break;
            case 4: gen_sxtb(tmp);   break;
            case 5: gen_uxtb(tmp);   break;
P
pbrook 已提交
7447 7448 7449
            default: goto illegal_op;
            }
            if (rn != 15) {
P
pbrook 已提交
7450
                tmp2 = load_reg(s, rn);
P
pbrook 已提交
7451
                if ((op >> 1) == 1) {
P
pbrook 已提交
7452
                    gen_add16(tmp, tmp2);
P
pbrook 已提交
7453
                } else {
P
pbrook 已提交
7454 7455
                    tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7456 7457
                }
            }
P
pbrook 已提交
7458
            store_reg(s, rd, tmp);
P
pbrook 已提交
7459 7460 7461 7462 7463 7464
            break;
        case 2: /* SIMD add/subtract.  */
            op = (insn >> 20) & 7;
            shift = (insn >> 4) & 7;
            if ((op & 3) == 3 || (shift & 3) == 3)
                goto illegal_op;
P
pbrook 已提交
7465 7466 7467 7468 7469
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
            gen_thumb2_parallel_addsub(op, shift, tmp, tmp2);
            dead_tmp(tmp2);
            store_reg(s, rd, tmp);
P
pbrook 已提交
7470 7471 7472 7473 7474
            break;
        case 3: /* Other data processing.  */
            op = ((insn >> 17) & 0x38) | ((insn >> 4) & 7);
            if (op < 4) {
                /* Saturating add/subtract.  */
P
pbrook 已提交
7475 7476
                tmp = load_reg(s, rn);
                tmp2 = load_reg(s, rm);
P
pbrook 已提交
7477
                if (op & 2)
P
pbrook 已提交
7478
                    gen_helper_double_saturate(tmp, tmp);
P
pbrook 已提交
7479
                if (op & 1)
P
pbrook 已提交
7480
                    gen_helper_sub_saturate(tmp, tmp2, tmp);
P
pbrook 已提交
7481
                else
P
pbrook 已提交
7482 7483
                    gen_helper_add_saturate(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7484
            } else {
P
pbrook 已提交
7485
                tmp = load_reg(s, rn);
P
pbrook 已提交
7486 7487
                switch (op) {
                case 0x0a: /* rbit */
P
pbrook 已提交
7488
                    gen_helper_rbit(tmp, tmp);
P
pbrook 已提交
7489 7490
                    break;
                case 0x08: /* rev */
A
aurel32 已提交
7491
                    tcg_gen_bswap32_i32(tmp, tmp);
P
pbrook 已提交
7492 7493
                    break;
                case 0x09: /* rev16 */
P
pbrook 已提交
7494
                    gen_rev16(tmp);
P
pbrook 已提交
7495 7496
                    break;
                case 0x0b: /* revsh */
P
pbrook 已提交
7497
                    gen_revsh(tmp);
P
pbrook 已提交
7498 7499
                    break;
                case 0x10: /* sel */
P
pbrook 已提交
7500
                    tmp2 = load_reg(s, rm);
P
pbrook 已提交
7501 7502
                    tmp3 = new_tmp();
                    tcg_gen_ld_i32(tmp3, cpu_env, offsetof(CPUState, GE));
P
pbrook 已提交
7503
                    gen_helper_sel_flags(tmp, tmp3, tmp, tmp2);
P
pbrook 已提交
7504
                    dead_tmp(tmp3);
P
pbrook 已提交
7505
                    dead_tmp(tmp2);
P
pbrook 已提交
7506 7507
                    break;
                case 0x18: /* clz */
P
pbrook 已提交
7508
                    gen_helper_clz(tmp, tmp);
P
pbrook 已提交
7509 7510 7511 7512 7513
                    break;
                default:
                    goto illegal_op;
                }
            }
P
pbrook 已提交
7514
            store_reg(s, rd, tmp);
P
pbrook 已提交
7515 7516 7517
            break;
        case 4: case 5: /* 32-bit multiply.  Sum of absolute differences.  */
            op = (insn >> 4) & 0xf;
P
pbrook 已提交
7518 7519
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7520 7521
            switch ((insn >> 20) & 7) {
            case 0: /* 32 x 32 -> 32 */
P
pbrook 已提交
7522 7523
                tcg_gen_mul_i32(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7524
                if (rs != 15) {
P
pbrook 已提交
7525
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
7526
                    if (op)
P
pbrook 已提交
7527
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
P
pbrook 已提交
7528
                    else
P
pbrook 已提交
7529 7530
                        tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7531 7532 7533
                }
                break;
            case 1: /* 16 x 16 -> 32 */
P
pbrook 已提交
7534 7535
                gen_mulxy(tmp, tmp2, op & 2, op & 1);
                dead_tmp(tmp2);
P
pbrook 已提交
7536
                if (rs != 15) {
P
pbrook 已提交
7537 7538 7539
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7540 7541 7542 7543 7544
                }
                break;
            case 2: /* Dual multiply add.  */
            case 4: /* Dual multiply subtract.  */
                if (op)
P
pbrook 已提交
7545 7546
                    gen_swap_half(tmp2);
                gen_smul_dual(tmp, tmp2);
P
pbrook 已提交
7547 7548
                /* This addition cannot overflow.  */
                if (insn & (1 << 22)) {
P
pbrook 已提交
7549
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
7550
                } else {
P
pbrook 已提交
7551
                    tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
7552
                }
P
pbrook 已提交
7553
                dead_tmp(tmp2);
P
pbrook 已提交
7554 7555
                if (rs != 15)
                  {
P
pbrook 已提交
7556 7557 7558
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7559 7560 7561 7562
                  }
                break;
            case 3: /* 32 * 16 -> 32msb */
                if (op)
P
pbrook 已提交
7563
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
P
pbrook 已提交
7564
                else
P
pbrook 已提交
7565
                    gen_sxth(tmp2);
P
pbrook 已提交
7566 7567
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
                tcg_gen_shri_i64(tmp64, tmp64, 16);
P
pbrook 已提交
7568
                tmp = new_tmp();
P
pbrook 已提交
7569
                tcg_gen_trunc_i64_i32(tmp, tmp64);
7570
                tcg_temp_free_i64(tmp64);
P
pbrook 已提交
7571 7572
                if (rs != 15)
                  {
P
pbrook 已提交
7573 7574 7575
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7576 7577 7578
                  }
                break;
            case 5: case 6: /* 32 * 32 -> 32msb */
P
pbrook 已提交
7579 7580 7581 7582 7583 7584 7585 7586
                gen_imull(tmp, tmp2);
                if (insn & (1 << 5)) {
                    gen_roundqd(tmp, tmp2);
                    dead_tmp(tmp2);
                } else {
                    dead_tmp(tmp);
                    tmp = tmp2;
                }
P
pbrook 已提交
7587
                if (rs != 15) {
P
pbrook 已提交
7588
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
7589
                    if (insn & (1 << 21)) {
P
pbrook 已提交
7590
                        tcg_gen_add_i32(tmp, tmp, tmp2);
B
bellard 已提交
7591
                    } else {
P
pbrook 已提交
7592
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
B
bellard 已提交
7593
                    }
P
pbrook 已提交
7594
                    dead_tmp(tmp2);
B
bellard 已提交
7595
                }
P
pbrook 已提交
7596 7597
                break;
            case 7: /* Unsigned sum of absolute differences.  */
P
pbrook 已提交
7598 7599
                gen_helper_usad8(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7600
                if (rs != 15) {
P
pbrook 已提交
7601 7602 7603
                    tmp2 = load_reg(s, rs);
                    tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
7604
                }
P
pbrook 已提交
7605
                break;
B
bellard 已提交
7606
            }
P
pbrook 已提交
7607
            store_reg(s, rd, tmp);
B
bellard 已提交
7608
            break;
P
pbrook 已提交
7609 7610
        case 6: case 7: /* 64-bit multiply, Divide.  */
            op = ((insn >> 4) & 0xf) | ((insn >> 16) & 0x70);
P
pbrook 已提交
7611 7612
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7613 7614 7615 7616 7617
            if ((op & 0x50) == 0x10) {
                /* sdiv, udiv */
                if (!arm_feature(env, ARM_FEATURE_DIV))
                    goto illegal_op;
                if (op & 0x20)
P
pbrook 已提交
7618
                    gen_helper_udiv(tmp, tmp, tmp2);
B
bellard 已提交
7619
                else
P
pbrook 已提交
7620 7621 7622
                    gen_helper_sdiv(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                store_reg(s, rd, tmp);
P
pbrook 已提交
7623 7624 7625
            } else if ((op & 0xe) == 0xc) {
                /* Dual multiply accumulate long.  */
                if (op & 1)
P
pbrook 已提交
7626 7627
                    gen_swap_half(tmp2);
                gen_smul_dual(tmp, tmp2);
P
pbrook 已提交
7628
                if (op & 0x10) {
P
pbrook 已提交
7629
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
B
bellard 已提交
7630
                } else {
P
pbrook 已提交
7631
                    tcg_gen_add_i32(tmp, tmp, tmp2);
B
bellard 已提交
7632
                }
P
pbrook 已提交
7633
                dead_tmp(tmp2);
P
pbrook 已提交
7634 7635 7636 7637 7638 7639
                /* BUGFIX */
                tmp64 = tcg_temp_new_i64();
                tcg_gen_ext_i32_i64(tmp64, tmp);
                dead_tmp(tmp);
                gen_addq(s, tmp64, rs, rd);
                gen_storeq_reg(s, rs, rd, tmp64);
7640
                tcg_temp_free_i64(tmp64);
B
bellard 已提交
7641
            } else {
P
pbrook 已提交
7642 7643
                if (op & 0x20) {
                    /* Unsigned 64-bit multiply  */
P
pbrook 已提交
7644
                    tmp64 = gen_mulu_i64_i32(tmp, tmp2);
B
bellard 已提交
7645
                } else {
P
pbrook 已提交
7646 7647
                    if (op & 8) {
                        /* smlalxy */
P
pbrook 已提交
7648 7649
                        gen_mulxy(tmp, tmp2, op & 2, op & 1);
                        dead_tmp(tmp2);
P
pbrook 已提交
7650 7651
                        tmp64 = tcg_temp_new_i64();
                        tcg_gen_ext_i32_i64(tmp64, tmp);
P
pbrook 已提交
7652
                        dead_tmp(tmp);
P
pbrook 已提交
7653 7654
                    } else {
                        /* Signed 64-bit multiply  */
P
pbrook 已提交
7655
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
7656
                    }
B
bellard 已提交
7657
                }
P
pbrook 已提交
7658 7659
                if (op & 4) {
                    /* umaal */
P
pbrook 已提交
7660 7661
                    gen_addq_lo(s, tmp64, rs);
                    gen_addq_lo(s, tmp64, rd);
P
pbrook 已提交
7662 7663
                } else if (op & 0x40) {
                    /* 64-bit accumulate.  */
P
pbrook 已提交
7664
                    gen_addq(s, tmp64, rs, rd);
P
pbrook 已提交
7665
                }
P
pbrook 已提交
7666
                gen_storeq_reg(s, rs, rd, tmp64);
7667
                tcg_temp_free_i64(tmp64);
7668
            }
B
bellard 已提交
7669
            break;
P
pbrook 已提交
7670 7671 7672 7673 7674 7675 7676 7677 7678 7679 7680 7681 7682 7683 7684 7685 7686 7687 7688 7689 7690 7691 7692 7693 7694 7695 7696 7697 7698 7699 7700 7701 7702
        }
        break;
    case 6: case 7: case 14: case 15:
        /* Coprocessor.  */
        if (((insn >> 24) & 3) == 3) {
            /* Translate into the equivalent ARM encoding.  */
            insn = (insn & 0xe2ffffff) | ((insn & (1 << 28)) >> 4);
            if (disas_neon_data_insn(env, s, insn))
                goto illegal_op;
        } else {
            if (insn & (1 << 28))
                goto illegal_op;
            if (disas_coproc_insn (env, s, insn))
                goto illegal_op;
        }
        break;
    case 8: case 9: case 10: case 11:
        if (insn & (1 << 15)) {
            /* Branches, misc control.  */
            if (insn & 0x5000) {
                /* Unconditional branch.  */
                /* signextend(hw1[10:0]) -> offset[:12].  */
                offset = ((int32_t)insn << 5) >> 9 & ~(int32_t)0xfff;
                /* hw1[10:0] -> offset[11:1].  */
                offset |= (insn & 0x7ff) << 1;
                /* (~hw2[13, 11] ^ offset[24]) -> offset[23,22]
                   offset[24:22] already have the same value because of the
                   sign extension above.  */
                offset ^= ((~insn) & (1 << 13)) << 10;
                offset ^= ((~insn) & (1 << 11)) << 11;

                if (insn & (1 << 14)) {
                    /* Branch and link.  */
7703
                    tcg_gen_movi_i32(cpu_R[14], s->pc | 1);
B
bellard 已提交
7704
                }
7705

P
pbrook 已提交
7706
                offset += s->pc;
P
pbrook 已提交
7707 7708
                if (insn & (1 << 12)) {
                    /* b/bl */
P
pbrook 已提交
7709
                    gen_jmp(s, offset);
P
pbrook 已提交
7710 7711
                } else {
                    /* blx */
P
pbrook 已提交
7712 7713
                    offset &= ~(uint32_t)2;
                    gen_bx_im(s, offset);
B
bellard 已提交
7714
                }
P
pbrook 已提交
7715 7716 7717 7718 7719 7720 7721 7722
            } else if (((insn >> 23) & 7) == 7) {
                /* Misc control */
                if (insn & (1 << 13))
                    goto illegal_op;

                if (insn & (1 << 26)) {
                    /* Secure monitor call (v6Z) */
                    goto illegal_op; /* not implemented.  */
B
bellard 已提交
7723
                } else {
P
pbrook 已提交
7724 7725 7726 7727
                    op = (insn >> 20) & 7;
                    switch (op) {
                    case 0: /* msr cpsr.  */
                        if (IS_M(env)) {
P
pbrook 已提交
7728 7729 7730
                            tmp = load_reg(s, rn);
                            addr = tcg_const_i32(insn & 0xff);
                            gen_helper_v7m_msr(cpu_env, addr, tmp);
7731 7732
                            tcg_temp_free_i32(addr);
                            dead_tmp(tmp);
P
pbrook 已提交
7733 7734 7735 7736 7737 7738 7739
                            gen_lookup_tb(s);
                            break;
                        }
                        /* fall through */
                    case 1: /* msr spsr.  */
                        if (IS_M(env))
                            goto illegal_op;
7740 7741
                        tmp = load_reg(s, rn);
                        if (gen_set_psr(s,
P
pbrook 已提交
7742
                              msr_mask(env, s, (insn >> 8) & 0xf, op == 1),
7743
                              op == 1, tmp))
P
pbrook 已提交
7744 7745 7746 7747 7748 7749 7750 7751 7752 7753 7754 7755 7756 7757 7758 7759 7760 7761 7762 7763 7764 7765 7766 7767 7768 7769
                            goto illegal_op;
                        break;
                    case 2: /* cps, nop-hint.  */
                        if (((insn >> 8) & 7) == 0) {
                            gen_nop_hint(s, insn & 0xff);
                        }
                        /* Implemented as NOP in user mode.  */
                        if (IS_USER(s))
                            break;
                        offset = 0;
                        imm = 0;
                        if (insn & (1 << 10)) {
                            if (insn & (1 << 7))
                                offset |= CPSR_A;
                            if (insn & (1 << 6))
                                offset |= CPSR_I;
                            if (insn & (1 << 5))
                                offset |= CPSR_F;
                            if (insn & (1 << 9))
                                imm = CPSR_A | CPSR_I | CPSR_F;
                        }
                        if (insn & (1 << 8)) {
                            offset |= 0x1f;
                            imm |= (insn & 0x1f);
                        }
                        if (offset) {
7770
                            gen_set_psr_im(s, offset, 0, imm);
P
pbrook 已提交
7771 7772 7773 7774 7775 7776
                        }
                        break;
                    case 3: /* Special control operations.  */
                        op = (insn >> 4) & 0xf;
                        switch (op) {
                        case 2: /* clrex */
P
pbrook 已提交
7777
                            gen_helper_clrex(cpu_env);
P
pbrook 已提交
7778 7779 7780 7781 7782 7783 7784 7785 7786 7787 7788 7789 7790
                            break;
                        case 4: /* dsb */
                        case 5: /* dmb */
                        case 6: /* isb */
                            /* These execute as NOPs.  */
                            ARCH(7);
                            break;
                        default:
                            goto illegal_op;
                        }
                        break;
                    case 4: /* bxj */
                        /* Trivial implementation equivalent to bx.  */
P
pbrook 已提交
7791 7792
                        tmp = load_reg(s, rn);
                        gen_bx(s, tmp);
P
pbrook 已提交
7793 7794 7795 7796 7797
                        break;
                    case 5: /* Exception return.  */
                        /* Unpredictable in user mode.  */
                        goto illegal_op;
                    case 6: /* mrs cpsr.  */
P
pbrook 已提交
7798
                        tmp = new_tmp();
P
pbrook 已提交
7799
                        if (IS_M(env)) {
P
pbrook 已提交
7800 7801
                            addr = tcg_const_i32(insn & 0xff);
                            gen_helper_v7m_mrs(tmp, cpu_env, addr);
7802
                            tcg_temp_free_i32(addr);
P
pbrook 已提交
7803
                        } else {
P
pbrook 已提交
7804
                            gen_helper_cpsr_read(tmp);
P
pbrook 已提交
7805
                        }
P
pbrook 已提交
7806
                        store_reg(s, rd, tmp);
P
pbrook 已提交
7807 7808 7809 7810 7811
                        break;
                    case 7: /* mrs spsr.  */
                        /* Not accessible in user mode.  */
                        if (IS_USER(s) || IS_M(env))
                            goto illegal_op;
P
pbrook 已提交
7812 7813
                        tmp = load_cpu_field(spsr);
                        store_reg(s, rd, tmp);
P
pbrook 已提交
7814
                        break;
B
bellard 已提交
7815 7816
                    }
                }
P
pbrook 已提交
7817 7818 7819 7820 7821
            } else {
                /* Conditional branch.  */
                op = (insn >> 22) & 0xf;
                /* Generate a conditional jump to next instruction.  */
                s->condlabel = gen_new_label();
P
pbrook 已提交
7822
                gen_test_cc(op ^ 1, s->condlabel);
P
pbrook 已提交
7823 7824 7825 7826 7827 7828 7829 7830 7831 7832 7833 7834 7835 7836
                s->condjmp = 1;

                /* offset[11:1] = insn[10:0] */
                offset = (insn & 0x7ff) << 1;
                /* offset[17:12] = insn[21:16].  */
                offset |= (insn & 0x003f0000) >> 4;
                /* offset[31:20] = insn[26].  */
                offset |= ((int32_t)((insn << 5) & 0x80000000)) >> 11;
                /* offset[18] = insn[13].  */
                offset |= (insn & (1 << 13)) << 5;
                /* offset[19] = insn[11].  */
                offset |= (insn & (1 << 11)) << 8;

                /* jump to the offset */
P
pbrook 已提交
7837
                gen_jmp(s, s->pc + offset);
P
pbrook 已提交
7838 7839 7840 7841 7842 7843 7844 7845 7846 7847 7848
            }
        } else {
            /* Data processing immediate.  */
            if (insn & (1 << 25)) {
                if (insn & (1 << 24)) {
                    if (insn & (1 << 20))
                        goto illegal_op;
                    /* Bitfield/Saturate.  */
                    op = (insn >> 21) & 7;
                    imm = insn & 0x1f;
                    shift = ((insn >> 6) & 3) | ((insn >> 10) & 0x1c);
P
pbrook 已提交
7849 7850 7851 7852 7853 7854
                    if (rn == 15) {
                        tmp = new_tmp();
                        tcg_gen_movi_i32(tmp, 0);
                    } else {
                        tmp = load_reg(s, rn);
                    }
P
pbrook 已提交
7855 7856 7857 7858 7859 7860
                    switch (op) {
                    case 2: /* Signed bitfield extract.  */
                        imm++;
                        if (shift + imm > 32)
                            goto illegal_op;
                        if (imm < 32)
P
pbrook 已提交
7861
                            gen_sbfx(tmp, shift, imm);
P
pbrook 已提交
7862 7863 7864 7865 7866 7867
                        break;
                    case 6: /* Unsigned bitfield extract.  */
                        imm++;
                        if (shift + imm > 32)
                            goto illegal_op;
                        if (imm < 32)
P
pbrook 已提交
7868
                            gen_ubfx(tmp, shift, (1u << imm) - 1);
P
pbrook 已提交
7869 7870 7871 7872 7873 7874
                        break;
                    case 3: /* Bitfield insert/clear.  */
                        if (imm < shift)
                            goto illegal_op;
                        imm = imm + 1 - shift;
                        if (imm != 32) {
P
pbrook 已提交
7875
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
7876
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << imm) - 1);
P
pbrook 已提交
7877
                            dead_tmp(tmp2);
P
pbrook 已提交
7878 7879 7880 7881 7882 7883 7884
                        }
                        break;
                    case 7:
                        goto illegal_op;
                    default: /* Saturate.  */
                        if (shift) {
                            if (op & 1)
P
pbrook 已提交
7885
                                tcg_gen_sari_i32(tmp, tmp, shift);
P
pbrook 已提交
7886
                            else
P
pbrook 已提交
7887
                                tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
7888
                        }
P
pbrook 已提交
7889
                        tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
7890 7891 7892
                        if (op & 4) {
                            /* Unsigned.  */
                            if ((op & 1) && shift == 0)
P
pbrook 已提交
7893
                                gen_helper_usat16(tmp, tmp, tmp2);
P
pbrook 已提交
7894
                            else
P
pbrook 已提交
7895
                                gen_helper_usat(tmp, tmp, tmp2);
B
bellard 已提交
7896
                        } else {
P
pbrook 已提交
7897 7898
                            /* Signed.  */
                            if ((op & 1) && shift == 0)
P
pbrook 已提交
7899
                                gen_helper_ssat16(tmp, tmp, tmp2);
P
pbrook 已提交
7900
                            else
P
pbrook 已提交
7901
                                gen_helper_ssat(tmp, tmp, tmp2);
B
bellard 已提交
7902
                        }
7903
                        tcg_temp_free_i32(tmp2);
P
pbrook 已提交
7904
                        break;
B
bellard 已提交
7905
                    }
P
pbrook 已提交
7906
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7907 7908 7909 7910 7911 7912 7913 7914
                } else {
                    imm = ((insn & 0x04000000) >> 15)
                          | ((insn & 0x7000) >> 4) | (insn & 0xff);
                    if (insn & (1 << 22)) {
                        /* 16-bit immediate.  */
                        imm |= (insn >> 4) & 0xf000;
                        if (insn & (1 << 23)) {
                            /* movt */
P
pbrook 已提交
7915
                            tmp = load_reg(s, rd);
P
pbrook 已提交
7916
                            tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
7917
                            tcg_gen_ori_i32(tmp, tmp, imm << 16);
B
bellard 已提交
7918
                        } else {
P
pbrook 已提交
7919
                            /* movw */
P
pbrook 已提交
7920 7921
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, imm);
B
bellard 已提交
7922 7923
                        }
                    } else {
P
pbrook 已提交
7924 7925
                        /* Add/sub 12-bit immediate.  */
                        if (rn == 15) {
P
pbrook 已提交
7926
                            offset = s->pc & ~(uint32_t)3;
P
pbrook 已提交
7927
                            if (insn & (1 << 23))
P
pbrook 已提交
7928
                                offset -= imm;
P
pbrook 已提交
7929
                            else
P
pbrook 已提交
7930
                                offset += imm;
P
pbrook 已提交
7931 7932
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, offset);
B
bellard 已提交
7933
                        } else {
P
pbrook 已提交
7934
                            tmp = load_reg(s, rn);
P
pbrook 已提交
7935
                            if (insn & (1 << 23))
P
pbrook 已提交
7936
                                tcg_gen_subi_i32(tmp, tmp, imm);
P
pbrook 已提交
7937
                            else
P
pbrook 已提交
7938
                                tcg_gen_addi_i32(tmp, tmp, imm);
B
bellard 已提交
7939
                        }
P
pbrook 已提交
7940
                    }
P
pbrook 已提交
7941
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7942
                }
P
pbrook 已提交
7943 7944 7945 7946 7947 7948 7949 7950 7951 7952 7953 7954 7955 7956 7957 7958 7959 7960 7961 7962 7963 7964 7965 7966 7967 7968
            } else {
                int shifter_out = 0;
                /* modified 12-bit immediate.  */
                shift = ((insn & 0x04000000) >> 23) | ((insn & 0x7000) >> 12);
                imm = (insn & 0xff);
                switch (shift) {
                case 0: /* XY */
                    /* Nothing to do.  */
                    break;
                case 1: /* 00XY00XY */
                    imm |= imm << 16;
                    break;
                case 2: /* XY00XY00 */
                    imm |= imm << 16;
                    imm <<= 8;
                    break;
                case 3: /* XYXYXYXY */
                    imm |= imm << 16;
                    imm |= imm << 8;
                    break;
                default: /* Rotated constant.  */
                    shift = (shift << 1) | (imm >> 7);
                    imm |= 0x80;
                    imm = imm << (32 - shift);
                    shifter_out = 1;
                    break;
B
bellard 已提交
7969
                }
7970 7971
                tmp2 = new_tmp();
                tcg_gen_movi_i32(tmp2, imm);
P
pbrook 已提交
7972
                rn = (insn >> 16) & 0xf;
7973 7974 7975 7976 7977 7978
                if (rn == 15) {
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, 0);
                } else {
                    tmp = load_reg(s, rn);
                }
P
pbrook 已提交
7979 7980
                op = (insn >> 21) & 0xf;
                if (gen_thumb2_data_op(s, op, (insn & (1 << 20)) != 0,
7981
                                       shifter_out, tmp, tmp2))
P
pbrook 已提交
7982
                    goto illegal_op;
7983
                dead_tmp(tmp2);
P
pbrook 已提交
7984 7985
                rd = (insn >> 8) & 0xf;
                if (rd != 15) {
7986 7987 7988
                    store_reg(s, rd, tmp);
                } else {
                    dead_tmp(tmp);
B
bellard 已提交
7989 7990
                }
            }
P
pbrook 已提交
7991 7992 7993 7994 7995 7996
        }
        break;
    case 12: /* Load/store single data item.  */
        {
        int postinc = 0;
        int writeback = 0;
P
pbrook 已提交
7997
        int user;
P
pbrook 已提交
7998 7999
        if ((insn & 0x01100000) == 0x01000000) {
            if (disas_neon_ls_insn(env, s, insn))
8000
                goto illegal_op;
P
pbrook 已提交
8001 8002
            break;
        }
P
pbrook 已提交
8003
        user = IS_USER(s);
P
pbrook 已提交
8004
        if (rn == 15) {
P
pbrook 已提交
8005
            addr = new_tmp();
P
pbrook 已提交
8006 8007 8008 8009 8010 8011 8012
            /* PC relative.  */
            /* s->pc has already been incremented by 4.  */
            imm = s->pc & 0xfffffffc;
            if (insn & (1 << 23))
                imm += insn & 0xfff;
            else
                imm -= insn & 0xfff;
P
pbrook 已提交
8013
            tcg_gen_movi_i32(addr, imm);
P
pbrook 已提交
8014
        } else {
P
pbrook 已提交
8015
            addr = load_reg(s, rn);
P
pbrook 已提交
8016 8017 8018
            if (insn & (1 << 23)) {
                /* Positive offset.  */
                imm = insn & 0xfff;
P
pbrook 已提交
8019
                tcg_gen_addi_i32(addr, addr, imm);
P
pbrook 已提交
8020 8021 8022 8023 8024 8025 8026
            } else {
                op = (insn >> 8) & 7;
                imm = insn & 0xff;
                switch (op) {
                case 0: case 8: /* Shifted Register.  */
                    shift = (insn >> 4) & 0xf;
                    if (shift > 3)
8027
                        goto illegal_op;
P
pbrook 已提交
8028
                    tmp = load_reg(s, rm);
P
pbrook 已提交
8029
                    if (shift)
P
pbrook 已提交
8030
                        tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
8031
                    tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
8032
                    dead_tmp(tmp);
P
pbrook 已提交
8033 8034
                    break;
                case 4: /* Negative offset.  */
P
pbrook 已提交
8035
                    tcg_gen_addi_i32(addr, addr, -imm);
P
pbrook 已提交
8036 8037
                    break;
                case 6: /* User privilege.  */
P
pbrook 已提交
8038 8039
                    tcg_gen_addi_i32(addr, addr, imm);
                    user = 1;
P
pbrook 已提交
8040 8041 8042 8043 8044 8045 8046 8047 8048 8049 8050 8051
                    break;
                case 1: /* Post-decrement.  */
                    imm = -imm;
                    /* Fall through.  */
                case 3: /* Post-increment.  */
                    postinc = 1;
                    writeback = 1;
                    break;
                case 5: /* Pre-decrement.  */
                    imm = -imm;
                    /* Fall through.  */
                case 7: /* Pre-increment.  */
P
pbrook 已提交
8052
                    tcg_gen_addi_i32(addr, addr, imm);
P
pbrook 已提交
8053 8054 8055
                    writeback = 1;
                    break;
                default:
B
bellard 已提交
8056
                    goto illegal_op;
P
pbrook 已提交
8057 8058 8059 8060 8061 8062 8063 8064
                }
            }
        }
        op = ((insn >> 21) & 3) | ((insn >> 22) & 4);
        if (insn & (1 << 20)) {
            /* Load.  */
            if (rs == 15 && op != 2) {
                if (op & 2)
B
bellard 已提交
8065
                    goto illegal_op;
P
pbrook 已提交
8066 8067 8068
                /* Memory hint.  Implemented as NOP.  */
            } else {
                switch (op) {
P
pbrook 已提交
8069 8070 8071 8072 8073
                case 0: tmp = gen_ld8u(addr, user); break;
                case 4: tmp = gen_ld8s(addr, user); break;
                case 1: tmp = gen_ld16u(addr, user); break;
                case 5: tmp = gen_ld16s(addr, user); break;
                case 2: tmp = gen_ld32(addr, user); break;
P
pbrook 已提交
8074 8075 8076
                default: goto illegal_op;
                }
                if (rs == 15) {
P
pbrook 已提交
8077
                    gen_bx(s, tmp);
P
pbrook 已提交
8078
                } else {
P
pbrook 已提交
8079
                    store_reg(s, rs, tmp);
P
pbrook 已提交
8080 8081 8082 8083 8084
                }
            }
        } else {
            /* Store.  */
            if (rs == 15)
B
bellard 已提交
8085
                goto illegal_op;
P
pbrook 已提交
8086
            tmp = load_reg(s, rs);
P
pbrook 已提交
8087
            switch (op) {
P
pbrook 已提交
8088 8089 8090
            case 0: gen_st8(tmp, addr, user); break;
            case 1: gen_st16(tmp, addr, user); break;
            case 2: gen_st32(tmp, addr, user); break;
P
pbrook 已提交
8091
            default: goto illegal_op;
B
bellard 已提交
8092
            }
B
bellard 已提交
8093
        }
P
pbrook 已提交
8094
        if (postinc)
P
pbrook 已提交
8095 8096 8097 8098 8099 8100
            tcg_gen_addi_i32(addr, addr, imm);
        if (writeback) {
            store_reg(s, rn, addr);
        } else {
            dead_tmp(addr);
        }
P
pbrook 已提交
8101 8102 8103 8104
        }
        break;
    default:
        goto illegal_op;
B
bellard 已提交
8105
    }
P
pbrook 已提交
8106 8107 8108
    return 0;
illegal_op:
    return 1;
B
bellard 已提交
8109 8110
}

P
pbrook 已提交
8111
static void disas_thumb_insn(CPUState *env, DisasContext *s)
B
bellard 已提交
8112 8113 8114 8115
{
    uint32_t val, insn, op, rm, rn, rd, shift, cond;
    int32_t offset;
    int i;
P
pbrook 已提交
8116
    TCGv tmp;
P
pbrook 已提交
8117
    TCGv tmp2;
P
pbrook 已提交
8118
    TCGv addr;
B
bellard 已提交
8119

P
pbrook 已提交
8120 8121 8122
    if (s->condexec_mask) {
        cond = s->condexec_cond;
        s->condlabel = gen_new_label();
P
pbrook 已提交
8123
        gen_test_cc(cond ^ 1, s->condlabel);
P
pbrook 已提交
8124 8125 8126
        s->condjmp = 1;
    }

B
bellard 已提交
8127
    insn = lduw_code(s->pc);
B
bellard 已提交
8128
    s->pc += 2;
B
bellard 已提交
8129

B
bellard 已提交
8130 8131
    switch (insn >> 12) {
    case 0: case 1:
8132

B
bellard 已提交
8133 8134 8135 8136 8137
        rd = insn & 7;
        op = (insn >> 11) & 3;
        if (op == 3) {
            /* add/subtract */
            rn = (insn >> 3) & 7;
8138
            tmp = load_reg(s, rn);
B
bellard 已提交
8139 8140
            if (insn & (1 << 10)) {
                /* immediate */
8141 8142
                tmp2 = new_tmp();
                tcg_gen_movi_i32(tmp2, (insn >> 6) & 7);
B
bellard 已提交
8143 8144 8145
            } else {
                /* reg */
                rm = (insn >> 6) & 7;
8146
                tmp2 = load_reg(s, rm);
B
bellard 已提交
8147
            }
P
pbrook 已提交
8148 8149
            if (insn & (1 << 9)) {
                if (s->condexec_mask)
8150
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8151
                else
8152
                    gen_helper_sub_cc(tmp, tmp, tmp2);
P
pbrook 已提交
8153 8154
            } else {
                if (s->condexec_mask)
8155
                    tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8156
                else
8157
                    gen_helper_add_cc(tmp, tmp, tmp2);
P
pbrook 已提交
8158
            }
8159 8160
            dead_tmp(tmp2);
            store_reg(s, rd, tmp);
B
bellard 已提交
8161 8162 8163 8164
        } else {
            /* shift immediate */
            rm = (insn >> 3) & 7;
            shift = (insn >> 6) & 0x1f;
P
pbrook 已提交
8165 8166 8167 8168 8169
            tmp = load_reg(s, rm);
            gen_arm_shift_im(tmp, op, shift, s->condexec_mask == 0);
            if (!s->condexec_mask)
                gen_logic_CC(tmp);
            store_reg(s, rd, tmp);
B
bellard 已提交
8170 8171 8172 8173 8174 8175
        }
        break;
    case 2: case 3:
        /* arithmetic large immediate */
        op = (insn >> 11) & 3;
        rd = (insn >> 8) & 0x7;
8176 8177 8178
        if (op == 0) { /* mov */
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, insn & 0xff);
P
pbrook 已提交
8179
            if (!s->condexec_mask)
8180 8181 8182 8183 8184 8185 8186 8187 8188 8189 8190 8191 8192 8193 8194 8195 8196 8197 8198 8199 8200 8201 8202 8203 8204 8205 8206 8207 8208
                gen_logic_CC(tmp);
            store_reg(s, rd, tmp);
        } else {
            tmp = load_reg(s, rd);
            tmp2 = new_tmp();
            tcg_gen_movi_i32(tmp2, insn & 0xff);
            switch (op) {
            case 1: /* cmp */
                gen_helper_sub_cc(tmp, tmp, tmp2);
                dead_tmp(tmp);
                dead_tmp(tmp2);
                break;
            case 2: /* add */
                if (s->condexec_mask)
                    tcg_gen_add_i32(tmp, tmp, tmp2);
                else
                    gen_helper_add_cc(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                store_reg(s, rd, tmp);
                break;
            case 3: /* sub */
                if (s->condexec_mask)
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
                else
                    gen_helper_sub_cc(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                store_reg(s, rd, tmp);
                break;
            }
B
bellard 已提交
8209 8210 8211 8212 8213
        }
        break;
    case 4:
        if (insn & (1 << 11)) {
            rd = (insn >> 8) & 7;
B
bellard 已提交
8214 8215 8216
            /* load pc-relative.  Bit 1 of PC is ignored.  */
            val = s->pc + 2 + ((insn & 0xff) * 4);
            val &= ~(uint32_t)2;
P
pbrook 已提交
8217 8218 8219 8220 8221
            addr = new_tmp();
            tcg_gen_movi_i32(addr, val);
            tmp = gen_ld32(addr, IS_USER(s));
            dead_tmp(addr);
            store_reg(s, rd, tmp);
B
bellard 已提交
8222 8223 8224 8225 8226 8227 8228 8229 8230
            break;
        }
        if (insn & (1 << 10)) {
            /* data processing extended or blx */
            rd = (insn & 7) | ((insn >> 4) & 8);
            rm = (insn >> 3) & 0xf;
            op = (insn >> 8) & 3;
            switch (op) {
            case 0: /* add */
8231 8232 8233 8234 8235
                tmp = load_reg(s, rd);
                tmp2 = load_reg(s, rm);
                tcg_gen_add_i32(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                store_reg(s, rd, tmp);
B
bellard 已提交
8236 8237
                break;
            case 1: /* cmp */
8238 8239 8240 8241 8242
                tmp = load_reg(s, rd);
                tmp2 = load_reg(s, rm);
                gen_helper_sub_cc(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                dead_tmp(tmp);
B
bellard 已提交
8243 8244
                break;
            case 2: /* mov/cpy */
8245 8246
                tmp = load_reg(s, rm);
                store_reg(s, rd, tmp);
B
bellard 已提交
8247 8248
                break;
            case 3:/* branch [and link] exchange thumb register */
P
pbrook 已提交
8249
                tmp = load_reg(s, rm);
B
bellard 已提交
8250 8251
                if (insn & (1 << 7)) {
                    val = (uint32_t)s->pc | 1;
P
pbrook 已提交
8252 8253 8254
                    tmp2 = new_tmp();
                    tcg_gen_movi_i32(tmp2, val);
                    store_reg(s, 14, tmp2);
B
bellard 已提交
8255
                }
P
pbrook 已提交
8256
                gen_bx(s, tmp);
B
bellard 已提交
8257 8258 8259 8260 8261 8262 8263 8264 8265 8266 8267 8268 8269 8270 8271 8272 8273 8274 8275
                break;
            }
            break;
        }

        /* data processing register */
        rd = insn & 7;
        rm = (insn >> 3) & 7;
        op = (insn >> 6) & 0xf;
        if (op == 2 || op == 3 || op == 4 || op == 7) {
            /* the shift/rotate ops want the operands backwards */
            val = rm;
            rm = rd;
            rd = val;
            val = 1;
        } else {
            val = 0;
        }

8276 8277 8278 8279 8280 8281 8282 8283
        if (op == 9) { /* neg */
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, 0);
        } else if (op != 0xf) { /* mvn doesn't read its first operand */
            tmp = load_reg(s, rd);
        } else {
            TCGV_UNUSED(tmp);
        }
B
bellard 已提交
8284

8285
        tmp2 = load_reg(s, rm);
B
bellard 已提交
8286
        switch (op) {
B
bellard 已提交
8287
        case 0x0: /* and */
8288
            tcg_gen_and_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8289
            if (!s->condexec_mask)
8290
                gen_logic_CC(tmp);
B
bellard 已提交
8291 8292
            break;
        case 0x1: /* eor */
8293
            tcg_gen_xor_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8294
            if (!s->condexec_mask)
8295
                gen_logic_CC(tmp);
B
bellard 已提交
8296 8297
            break;
        case 0x2: /* lsl */
P
pbrook 已提交
8298
            if (s->condexec_mask) {
8299
                gen_helper_shl(tmp2, tmp2, tmp);
P
pbrook 已提交
8300
            } else {
8301 8302
                gen_helper_shl_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8303
            }
B
bellard 已提交
8304 8305
            break;
        case 0x3: /* lsr */
P
pbrook 已提交
8306
            if (s->condexec_mask) {
8307
                gen_helper_shr(tmp2, tmp2, tmp);
P
pbrook 已提交
8308
            } else {
8309 8310
                gen_helper_shr_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8311
            }
B
bellard 已提交
8312 8313
            break;
        case 0x4: /* asr */
P
pbrook 已提交
8314
            if (s->condexec_mask) {
8315
                gen_helper_sar(tmp2, tmp2, tmp);
P
pbrook 已提交
8316
            } else {
8317 8318
                gen_helper_sar_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8319
            }
B
bellard 已提交
8320 8321
            break;
        case 0x5: /* adc */
P
pbrook 已提交
8322
            if (s->condexec_mask)
8323
                gen_adc(tmp, tmp2);
P
pbrook 已提交
8324
            else
8325
                gen_helper_adc_cc(tmp, tmp, tmp2);
B
bellard 已提交
8326 8327
            break;
        case 0x6: /* sbc */
P
pbrook 已提交
8328
            if (s->condexec_mask)
8329
                gen_sub_carry(tmp, tmp, tmp2);
P
pbrook 已提交
8330
            else
8331
                gen_helper_sbc_cc(tmp, tmp, tmp2);
B
bellard 已提交
8332 8333
            break;
        case 0x7: /* ror */
P
pbrook 已提交
8334
            if (s->condexec_mask) {
8335
                gen_helper_ror(tmp2, tmp2, tmp);
P
pbrook 已提交
8336
            } else {
8337 8338
                gen_helper_ror_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8339
            }
B
bellard 已提交
8340 8341
            break;
        case 0x8: /* tst */
8342 8343
            tcg_gen_and_i32(tmp, tmp, tmp2);
            gen_logic_CC(tmp);
B
bellard 已提交
8344
            rd = 16;
B
bellard 已提交
8345
            break;
B
bellard 已提交
8346
        case 0x9: /* neg */
P
pbrook 已提交
8347
            if (s->condexec_mask)
8348
                tcg_gen_neg_i32(tmp, tmp2);
P
pbrook 已提交
8349
            else
8350
                gen_helper_sub_cc(tmp, tmp, tmp2);
B
bellard 已提交
8351 8352
            break;
        case 0xa: /* cmp */
8353
            gen_helper_sub_cc(tmp, tmp, tmp2);
B
bellard 已提交
8354 8355 8356
            rd = 16;
            break;
        case 0xb: /* cmn */
8357
            gen_helper_add_cc(tmp, tmp, tmp2);
B
bellard 已提交
8358 8359 8360
            rd = 16;
            break;
        case 0xc: /* orr */
8361
            tcg_gen_or_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8362
            if (!s->condexec_mask)
8363
                gen_logic_CC(tmp);
B
bellard 已提交
8364 8365
            break;
        case 0xd: /* mul */
8366
            gen_mull(tmp, tmp2);
P
pbrook 已提交
8367
            if (!s->condexec_mask)
8368
                gen_logic_CC(tmp);
B
bellard 已提交
8369 8370
            break;
        case 0xe: /* bic */
8371
            tcg_gen_bic_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8372
            if (!s->condexec_mask)
8373
                gen_logic_CC(tmp);
B
bellard 已提交
8374 8375
            break;
        case 0xf: /* mvn */
8376
            tcg_gen_not_i32(tmp2, tmp2);
P
pbrook 已提交
8377
            if (!s->condexec_mask)
8378
                gen_logic_CC(tmp2);
B
bellard 已提交
8379
            val = 1;
B
bellard 已提交
8380
            rm = rd;
B
bellard 已提交
8381 8382 8383
            break;
        }
        if (rd != 16) {
8384 8385 8386 8387 8388 8389 8390 8391 8392 8393 8394
            if (val) {
                store_reg(s, rm, tmp2);
                if (op != 0xf)
                    dead_tmp(tmp);
            } else {
                store_reg(s, rd, tmp);
                dead_tmp(tmp2);
            }
        } else {
            dead_tmp(tmp);
            dead_tmp(tmp2);
B
bellard 已提交
8395 8396 8397 8398 8399 8400 8401 8402 8403
        }
        break;

    case 5:
        /* load/store register offset.  */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
        rm = (insn >> 6) & 7;
        op = (insn >> 9) & 7;
P
pbrook 已提交
8404
        addr = load_reg(s, rn);
P
pbrook 已提交
8405
        tmp = load_reg(s, rm);
P
pbrook 已提交
8406
        tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
8407
        dead_tmp(tmp);
B
bellard 已提交
8408 8409

        if (op < 3) /* store */
P
pbrook 已提交
8410
            tmp = load_reg(s, rd);
B
bellard 已提交
8411 8412 8413

        switch (op) {
        case 0: /* str */
P
pbrook 已提交
8414
            gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8415 8416
            break;
        case 1: /* strh */
P
pbrook 已提交
8417
            gen_st16(tmp, addr, IS_USER(s));
B
bellard 已提交
8418 8419
            break;
        case 2: /* strb */
P
pbrook 已提交
8420
            gen_st8(tmp, addr, IS_USER(s));
B
bellard 已提交
8421 8422
            break;
        case 3: /* ldrsb */
P
pbrook 已提交
8423
            tmp = gen_ld8s(addr, IS_USER(s));
B
bellard 已提交
8424 8425
            break;
        case 4: /* ldr */
P
pbrook 已提交
8426
            tmp = gen_ld32(addr, IS_USER(s));
B
bellard 已提交
8427 8428
            break;
        case 5: /* ldrh */
P
pbrook 已提交
8429
            tmp = gen_ld16u(addr, IS_USER(s));
B
bellard 已提交
8430 8431
            break;
        case 6: /* ldrb */
P
pbrook 已提交
8432
            tmp = gen_ld8u(addr, IS_USER(s));
B
bellard 已提交
8433 8434
            break;
        case 7: /* ldrsh */
P
pbrook 已提交
8435
            tmp = gen_ld16s(addr, IS_USER(s));
B
bellard 已提交
8436 8437 8438
            break;
        }
        if (op >= 3) /* load */
P
pbrook 已提交
8439 8440
            store_reg(s, rd, tmp);
        dead_tmp(addr);
B
bellard 已提交
8441 8442 8443 8444 8445 8446
        break;

    case 6:
        /* load/store word immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8447
        addr = load_reg(s, rn);
B
bellard 已提交
8448
        val = (insn >> 4) & 0x7c;
P
pbrook 已提交
8449
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8450 8451 8452

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8453 8454
            tmp = gen_ld32(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8455 8456
        } else {
            /* store */
P
pbrook 已提交
8457 8458
            tmp = load_reg(s, rd);
            gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8459
        }
P
pbrook 已提交
8460
        dead_tmp(addr);
B
bellard 已提交
8461 8462 8463 8464 8465 8466
        break;

    case 7:
        /* load/store byte immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8467
        addr = load_reg(s, rn);
B
bellard 已提交
8468
        val = (insn >> 6) & 0x1f;
P
pbrook 已提交
8469
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8470 8471 8472

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8473 8474
            tmp = gen_ld8u(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8475 8476
        } else {
            /* store */
P
pbrook 已提交
8477 8478
            tmp = load_reg(s, rd);
            gen_st8(tmp, addr, IS_USER(s));
B
bellard 已提交
8479
        }
P
pbrook 已提交
8480
        dead_tmp(addr);
B
bellard 已提交
8481 8482 8483 8484 8485 8486
        break;

    case 8:
        /* load/store halfword immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8487
        addr = load_reg(s, rn);
B
bellard 已提交
8488
        val = (insn >> 5) & 0x3e;
P
pbrook 已提交
8489
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8490 8491 8492

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8493 8494
            tmp = gen_ld16u(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8495 8496
        } else {
            /* store */
P
pbrook 已提交
8497 8498
            tmp = load_reg(s, rd);
            gen_st16(tmp, addr, IS_USER(s));
B
bellard 已提交
8499
        }
P
pbrook 已提交
8500
        dead_tmp(addr);
B
bellard 已提交
8501 8502 8503 8504 8505
        break;

    case 9:
        /* load/store from stack */
        rd = (insn >> 8) & 7;
P
pbrook 已提交
8506
        addr = load_reg(s, 13);
B
bellard 已提交
8507
        val = (insn & 0xff) * 4;
P
pbrook 已提交
8508
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8509 8510 8511

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8512 8513
            tmp = gen_ld32(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8514 8515
        } else {
            /* store */
P
pbrook 已提交
8516 8517
            tmp = load_reg(s, rd);
            gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8518
        }
P
pbrook 已提交
8519
        dead_tmp(addr);
B
bellard 已提交
8520 8521 8522 8523 8524
        break;

    case 10:
        /* add to high reg */
        rd = (insn >> 8) & 7;
B
bellard 已提交
8525 8526
        if (insn & (1 << 11)) {
            /* SP */
P
pbrook 已提交
8527
            tmp = load_reg(s, 13);
B
bellard 已提交
8528 8529
        } else {
            /* PC. bit 1 is ignored.  */
P
pbrook 已提交
8530 8531
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, (s->pc + 2) & ~(uint32_t)2);
B
bellard 已提交
8532
        }
B
bellard 已提交
8533
        val = (insn & 0xff) * 4;
P
pbrook 已提交
8534 8535
        tcg_gen_addi_i32(tmp, tmp, val);
        store_reg(s, rd, tmp);
B
bellard 已提交
8536 8537 8538 8539 8540 8541 8542 8543
        break;

    case 11:
        /* misc */
        op = (insn >> 8) & 0xf;
        switch (op) {
        case 0:
            /* adjust stack pointer */
P
pbrook 已提交
8544
            tmp = load_reg(s, 13);
B
bellard 已提交
8545 8546
            val = (insn & 0x7f) * 4;
            if (insn & (1 << 7))
B
balrog 已提交
8547
                val = -(int32_t)val;
P
pbrook 已提交
8548 8549
            tcg_gen_addi_i32(tmp, tmp, val);
            store_reg(s, 13, tmp);
B
bellard 已提交
8550 8551
            break;

P
pbrook 已提交
8552 8553 8554 8555
        case 2: /* sign/zero extend.  */
            ARCH(6);
            rd = insn & 7;
            rm = (insn >> 3) & 7;
P
pbrook 已提交
8556
            tmp = load_reg(s, rm);
P
pbrook 已提交
8557
            switch ((insn >> 6) & 3) {
P
pbrook 已提交
8558 8559 8560 8561
            case 0: gen_sxth(tmp); break;
            case 1: gen_sxtb(tmp); break;
            case 2: gen_uxth(tmp); break;
            case 3: gen_uxtb(tmp); break;
P
pbrook 已提交
8562
            }
P
pbrook 已提交
8563
            store_reg(s, rd, tmp);
P
pbrook 已提交
8564
            break;
B
bellard 已提交
8565 8566
        case 4: case 5: case 0xc: case 0xd:
            /* push/pop */
P
pbrook 已提交
8567
            addr = load_reg(s, 13);
B
bellard 已提交
8568 8569
            if (insn & (1 << 8))
                offset = 4;
B
bellard 已提交
8570
            else
B
bellard 已提交
8571 8572 8573 8574 8575 8576
                offset = 0;
            for (i = 0; i < 8; i++) {
                if (insn & (1 << i))
                    offset += 4;
            }
            if ((insn & (1 << 11)) == 0) {
P
pbrook 已提交
8577
                tcg_gen_addi_i32(addr, addr, -offset);
B
bellard 已提交
8578
            }
B
bellard 已提交
8579 8580 8581 8582
            for (i = 0; i < 8; i++) {
                if (insn & (1 << i)) {
                    if (insn & (1 << 11)) {
                        /* pop */
P
pbrook 已提交
8583 8584
                        tmp = gen_ld32(addr, IS_USER(s));
                        store_reg(s, i, tmp);
B
bellard 已提交
8585 8586
                    } else {
                        /* push */
P
pbrook 已提交
8587 8588
                        tmp = load_reg(s, i);
                        gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8589
                    }
B
bellard 已提交
8590
                    /* advance to the next address.  */
P
pbrook 已提交
8591
                    tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8592 8593
                }
            }
P
pbrook 已提交
8594
            TCGV_UNUSED(tmp);
B
bellard 已提交
8595 8596 8597
            if (insn & (1 << 8)) {
                if (insn & (1 << 11)) {
                    /* pop pc */
P
pbrook 已提交
8598
                    tmp = gen_ld32(addr, IS_USER(s));
B
bellard 已提交
8599 8600 8601 8602
                    /* don't set the pc until the rest of the instruction
                       has completed */
                } else {
                    /* push lr */
P
pbrook 已提交
8603 8604
                    tmp = load_reg(s, 14);
                    gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8605
                }
P
pbrook 已提交
8606
                tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8607
            }
B
bellard 已提交
8608
            if ((insn & (1 << 11)) == 0) {
P
pbrook 已提交
8609
                tcg_gen_addi_i32(addr, addr, -offset);
B
bellard 已提交
8610
            }
B
bellard 已提交
8611
            /* write back the new stack pointer */
P
pbrook 已提交
8612
            store_reg(s, 13, addr);
B
bellard 已提交
8613 8614
            /* set the new PC value */
            if ((insn & 0x0900) == 0x0900)
P
pbrook 已提交
8615
                gen_bx(s, tmp);
B
bellard 已提交
8616 8617
            break;

P
pbrook 已提交
8618 8619
        case 1: case 3: case 9: case 11: /* czb */
            rm = insn & 7;
P
pbrook 已提交
8620
            tmp = load_reg(s, rm);
P
pbrook 已提交
8621 8622 8623
            s->condlabel = gen_new_label();
            s->condjmp = 1;
            if (insn & (1 << 11))
P
pbrook 已提交
8624
                tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, s->condlabel);
P
pbrook 已提交
8625
            else
P
pbrook 已提交
8626
                tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, s->condlabel);
P
pbrook 已提交
8627
            dead_tmp(tmp);
P
pbrook 已提交
8628 8629 8630 8631 8632 8633 8634 8635 8636 8637 8638 8639 8640 8641 8642 8643 8644
            offset = ((insn & 0xf8) >> 2) | (insn & 0x200) >> 3;
            val = (uint32_t)s->pc + 2;
            val += offset;
            gen_jmp(s, val);
            break;

        case 15: /* IT, nop-hint.  */
            if ((insn & 0xf) == 0) {
                gen_nop_hint(s, (insn >> 4) & 0xf);
                break;
            }
            /* If Then.  */
            s->condexec_cond = (insn >> 4) & 0xe;
            s->condexec_mask = insn & 0x1f;
            /* No actual code generated for this insn, just setup state.  */
            break;

P
pbrook 已提交
8645
        case 0xe: /* bkpt */
P
pbrook 已提交
8646
            gen_set_condexec(s);
P
pbrook 已提交
8647
            gen_set_pc_im(s->pc - 2);
P
pbrook 已提交
8648
            gen_exception(EXCP_BKPT);
P
pbrook 已提交
8649 8650 8651
            s->is_jmp = DISAS_JUMP;
            break;

P
pbrook 已提交
8652 8653 8654 8655
        case 0xa: /* rev */
            ARCH(6);
            rn = (insn >> 3) & 0x7;
            rd = insn & 0x7;
P
pbrook 已提交
8656
            tmp = load_reg(s, rn);
P
pbrook 已提交
8657
            switch ((insn >> 6) & 3) {
A
aurel32 已提交
8658
            case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
P
pbrook 已提交
8659 8660
            case 1: gen_rev16(tmp); break;
            case 3: gen_revsh(tmp); break;
P
pbrook 已提交
8661 8662
            default: goto illegal_op;
            }
P
pbrook 已提交
8663
            store_reg(s, rd, tmp);
P
pbrook 已提交
8664 8665 8666 8667 8668 8669 8670
            break;

        case 6: /* cps */
            ARCH(6);
            if (IS_USER(s))
                break;
            if (IS_M(env)) {
P
pbrook 已提交
8671
                tmp = tcg_const_i32((insn & (1 << 4)) != 0);
P
pbrook 已提交
8672
                /* PRIMASK */
P
pbrook 已提交
8673 8674 8675
                if (insn & 1) {
                    addr = tcg_const_i32(16);
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
8676
                    tcg_temp_free_i32(addr);
P
pbrook 已提交
8677
                }
P
pbrook 已提交
8678
                /* FAULTMASK */
P
pbrook 已提交
8679 8680 8681
                if (insn & 2) {
                    addr = tcg_const_i32(17);
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
8682
                    tcg_temp_free_i32(addr);
P
pbrook 已提交
8683
                }
8684
                tcg_temp_free_i32(tmp);
P
pbrook 已提交
8685 8686 8687 8688 8689 8690
                gen_lookup_tb(s);
            } else {
                if (insn & (1 << 4))
                    shift = CPSR_A | CPSR_I | CPSR_F;
                else
                    shift = 0;
8691
                gen_set_psr_im(s, shift, 0, ((insn & 7) << 6) & shift);
P
pbrook 已提交
8692 8693 8694
            }
            break;

B
bellard 已提交
8695 8696 8697 8698 8699 8700 8701 8702
        default:
            goto undef;
        }
        break;

    case 12:
        /* load/store multiple */
        rn = (insn >> 8) & 0x7;
P
pbrook 已提交
8703
        addr = load_reg(s, rn);
B
bellard 已提交
8704 8705 8706 8707
        for (i = 0; i < 8; i++) {
            if (insn & (1 << i)) {
                if (insn & (1 << 11)) {
                    /* load */
P
pbrook 已提交
8708 8709
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, i, tmp);
B
bellard 已提交
8710 8711
                } else {
                    /* store */
P
pbrook 已提交
8712 8713
                    tmp = load_reg(s, i);
                    gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8714
                }
B
bellard 已提交
8715
                /* advance to the next address */
P
pbrook 已提交
8716
                tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8717 8718
            }
        }
B
bellard 已提交
8719
        /* Base register writeback.  */
P
pbrook 已提交
8720 8721 8722 8723 8724
        if ((insn & (1 << rn)) == 0) {
            store_reg(s, rn, addr);
        } else {
            dead_tmp(addr);
        }
B
bellard 已提交
8725 8726 8727 8728 8729 8730 8731 8732 8733 8734
        break;

    case 13:
        /* conditional branch or swi */
        cond = (insn >> 8) & 0xf;
        if (cond == 0xe)
            goto undef;

        if (cond == 0xf) {
            /* swi */
P
pbrook 已提交
8735
            gen_set_condexec(s);
8736
            gen_set_pc_im(s->pc);
P
pbrook 已提交
8737
            s->is_jmp = DISAS_SWI;
B
bellard 已提交
8738 8739 8740
            break;
        }
        /* generate a conditional jump to next instruction */
8741
        s->condlabel = gen_new_label();
P
pbrook 已提交
8742
        gen_test_cc(cond ^ 1, s->condlabel);
8743
        s->condjmp = 1;
B
bellard 已提交
8744 8745

        /* jump to the offset */
B
bellard 已提交
8746
        val = (uint32_t)s->pc + 2;
B
bellard 已提交
8747
        offset = ((int32_t)insn << 24) >> 24;
B
bellard 已提交
8748
        val += offset << 1;
B
bellard 已提交
8749
        gen_jmp(s, val);
B
bellard 已提交
8750 8751 8752
        break;

    case 14:
P
pbrook 已提交
8753
        if (insn & (1 << 11)) {
P
pbrook 已提交
8754 8755
            if (disas_thumb2_insn(env, s, insn))
              goto undef32;
P
pbrook 已提交
8756 8757
            break;
        }
P
pbrook 已提交
8758
        /* unconditional branch */
B
bellard 已提交
8759 8760 8761
        val = (uint32_t)s->pc;
        offset = ((int32_t)insn << 21) >> 21;
        val += (offset << 1) + 2;
B
bellard 已提交
8762
        gen_jmp(s, val);
B
bellard 已提交
8763 8764 8765
        break;

    case 15:
P
pbrook 已提交
8766
        if (disas_thumb2_insn(env, s, insn))
B
balrog 已提交
8767
            goto undef32;
P
pbrook 已提交
8768
        break;
B
bellard 已提交
8769 8770
    }
    return;
P
pbrook 已提交
8771 8772
undef32:
    gen_set_condexec(s);
P
pbrook 已提交
8773
    gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
8774
    gen_exception(EXCP_UDEF);
P
pbrook 已提交
8775 8776 8777
    s->is_jmp = DISAS_JUMP;
    return;
illegal_op:
B
bellard 已提交
8778
undef:
P
pbrook 已提交
8779
    gen_set_condexec(s);
P
pbrook 已提交
8780
    gen_set_pc_im(s->pc - 2);
P
pbrook 已提交
8781
    gen_exception(EXCP_UDEF);
B
bellard 已提交
8782 8783 8784
    s->is_jmp = DISAS_JUMP;
}

B
bellard 已提交
8785 8786 8787
/* generate intermediate code in gen_opc_buf and gen_opparam_buf for
   basic block 'tb'. If search_pc is TRUE, also generate PC
   information for each intermediate instruction. */
8788 8789 8790
static inline void gen_intermediate_code_internal(CPUState *env,
                                                  TranslationBlock *tb,
                                                  int search_pc)
B
bellard 已提交
8791 8792
{
    DisasContext dc1, *dc = &dc1;
8793
    CPUBreakpoint *bp;
B
bellard 已提交
8794 8795
    uint16_t *gen_opc_end;
    int j, lj;
B
bellard 已提交
8796
    target_ulong pc_start;
B
bellard 已提交
8797
    uint32_t next_page_start;
P
pbrook 已提交
8798 8799
    int num_insns;
    int max_insns;
8800

B
bellard 已提交
8801
    /* generate intermediate code */
P
pbrook 已提交
8802 8803
    num_temps = 0;

B
bellard 已提交
8804
    pc_start = tb->pc;
8805

B
bellard 已提交
8806 8807 8808 8809 8810 8811
    dc->tb = tb;

    gen_opc_end = gen_opc_buf + OPC_MAX_SIZE;

    dc->is_jmp = DISAS_NEXT;
    dc->pc = pc_start;
B
bellard 已提交
8812
    dc->singlestep_enabled = env->singlestep_enabled;
8813
    dc->condjmp = 0;
B
bellard 已提交
8814
    dc->thumb = env->thumb;
P
pbrook 已提交
8815 8816
    dc->condexec_mask = (env->condexec_bits & 0xf) << 1;
    dc->condexec_cond = env->condexec_bits >> 4;
B
bellard 已提交
8817
#if !defined(CONFIG_USER_ONLY)
P
pbrook 已提交
8818 8819 8820 8821 8822
    if (IS_M(env)) {
        dc->user = ((env->v7m.exception == 0) && (env->v7m.control & 1));
    } else {
        dc->user = (env->uncached_cpsr & 0x1f) == ARM_CPU_MODE_USR;
    }
B
bellard 已提交
8823
#endif
P
pbrook 已提交
8824 8825 8826 8827
    cpu_F0s = tcg_temp_new_i32();
    cpu_F1s = tcg_temp_new_i32();
    cpu_F0d = tcg_temp_new_i64();
    cpu_F1d = tcg_temp_new_i64();
P
pbrook 已提交
8828 8829
    cpu_V0 = cpu_F0d;
    cpu_V1 = cpu_F1d;
P
pbrook 已提交
8830
    /* FIXME: cpu_M0 can probably be the same as cpu_V0.  */
P
pbrook 已提交
8831
    cpu_M0 = tcg_temp_new_i64();
B
bellard 已提交
8832
    next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
B
bellard 已提交
8833
    lj = -1;
P
pbrook 已提交
8834 8835 8836 8837 8838 8839
    num_insns = 0;
    max_insns = tb->cflags & CF_COUNT_MASK;
    if (max_insns == 0)
        max_insns = CF_COUNT_MASK;

    gen_icount_start();
P
pbrook 已提交
8840 8841 8842
    /* Reset the conditional execution bits immediately. This avoids
       complications trying to do it at the end of the block.  */
    if (env->condexec_bits)
P
pbrook 已提交
8843 8844 8845
      {
        TCGv tmp = new_tmp();
        tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
8846
        store_cpu_field(tmp, condexec_bits);
P
pbrook 已提交
8847
      }
B
bellard 已提交
8848
    do {
8849 8850 8851 8852 8853 8854 8855 8856 8857 8858
#ifdef CONFIG_USER_ONLY
        /* Intercept jump to the magic kernel page.  */
        if (dc->pc >= 0xffff0000) {
            /* We always get here via a jump, so know we are not in a
               conditional execution block.  */
            gen_exception(EXCP_KERNEL_TRAP);
            dc->is_jmp = DISAS_UPDATE;
            break;
        }
#else
P
pbrook 已提交
8859 8860 8861
        if (dc->pc >= 0xfffffff0 && IS_M(env)) {
            /* We always get here via a jump, so know we are not in a
               conditional execution block.  */
P
pbrook 已提交
8862
            gen_exception(EXCP_EXCEPTION_EXIT);
8863 8864
            dc->is_jmp = DISAS_UPDATE;
            break;
P
pbrook 已提交
8865 8866 8867
        }
#endif

B
Blue Swirl 已提交
8868 8869
        if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
            QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
8870
                if (bp->pc == dc->pc) {
P
pbrook 已提交
8871
                    gen_set_condexec(dc);
P
pbrook 已提交
8872
                    gen_set_pc_im(dc->pc);
P
pbrook 已提交
8873
                    gen_exception(EXCP_DEBUG);
B
bellard 已提交
8874
                    dc->is_jmp = DISAS_JUMP;
P
pbrook 已提交
8875 8876 8877 8878
                    /* Advance PC so that clearing the breakpoint will
                       invalidate this TB.  */
                    dc->pc += 2;
                    goto done_generating;
B
bellard 已提交
8879 8880 8881 8882
                    break;
                }
            }
        }
B
bellard 已提交
8883 8884 8885 8886 8887 8888 8889
        if (search_pc) {
            j = gen_opc_ptr - gen_opc_buf;
            if (lj < j) {
                lj++;
                while (lj < j)
                    gen_opc_instr_start[lj++] = 0;
            }
B
bellard 已提交
8890
            gen_opc_pc[lj] = dc->pc;
B
bellard 已提交
8891
            gen_opc_instr_start[lj] = 1;
P
pbrook 已提交
8892
            gen_opc_icount[lj] = num_insns;
B
bellard 已提交
8893
        }
8894

P
pbrook 已提交
8895 8896 8897
        if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO))
            gen_io_start();

P
pbrook 已提交
8898 8899 8900 8901 8902 8903 8904 8905 8906 8907 8908 8909 8910
        if (env->thumb) {
            disas_thumb_insn(env, dc);
            if (dc->condexec_mask) {
                dc->condexec_cond = (dc->condexec_cond & 0xe)
                                   | ((dc->condexec_mask >> 4) & 1);
                dc->condexec_mask = (dc->condexec_mask << 1) & 0x1f;
                if (dc->condexec_mask == 0) {
                    dc->condexec_cond = 0;
                }
            }
        } else {
            disas_arm_insn(env, dc);
        }
P
pbrook 已提交
8911 8912 8913 8914
        if (num_temps) {
            fprintf(stderr, "Internal resource leak before %08x\n", dc->pc);
            num_temps = 0;
        }
8915 8916 8917 8918 8919

        if (dc->condjmp && !dc->is_jmp) {
            gen_set_label(dc->condlabel);
            dc->condjmp = 0;
        }
B
balrog 已提交
8920
        /* Translation stops when a conditional branch is encountered.
8921
         * Otherwise the subsequent code could get translated several times.
B
bellard 已提交
8922
         * Also stop translation when a page boundary is reached.  This
T
ths 已提交
8923
         * ensures prefetch aborts occur at the right place.  */
P
pbrook 已提交
8924
        num_insns ++;
B
bellard 已提交
8925 8926
    } while (!dc->is_jmp && gen_opc_ptr < gen_opc_end &&
             !env->singlestep_enabled &&
8927
             !singlestep &&
P
pbrook 已提交
8928 8929 8930 8931 8932 8933 8934 8935 8936 8937 8938
             dc->pc < next_page_start &&
             num_insns < max_insns);

    if (tb->cflags & CF_LAST_IO) {
        if (dc->condjmp) {
            /* FIXME:  This can theoretically happen with self-modifying
               code.  */
            cpu_abort(env, "IO on conditional branch instruction");
        }
        gen_io_end();
    }
P
pbrook 已提交
8939

B
bellard 已提交
8940
    /* At this stage dc->condjmp will only be set when the skipped
P
pbrook 已提交
8941 8942
       instruction was a conditional branch or trap, and the PC has
       already been written.  */
8943
    if (unlikely(env->singlestep_enabled)) {
B
bellard 已提交
8944
        /* Make sure the pc is updated, and raise a debug exception.  */
8945
        if (dc->condjmp) {
P
pbrook 已提交
8946 8947
            gen_set_condexec(dc);
            if (dc->is_jmp == DISAS_SWI) {
P
pbrook 已提交
8948
                gen_exception(EXCP_SWI);
P
pbrook 已提交
8949
            } else {
P
pbrook 已提交
8950
                gen_exception(EXCP_DEBUG);
P
pbrook 已提交
8951
            }
8952 8953 8954
            gen_set_label(dc->condlabel);
        }
        if (dc->condjmp || !dc->is_jmp) {
P
pbrook 已提交
8955
            gen_set_pc_im(dc->pc);
8956
            dc->condjmp = 0;
B
bellard 已提交
8957
        }
P
pbrook 已提交
8958 8959
        gen_set_condexec(dc);
        if (dc->is_jmp == DISAS_SWI && !dc->condjmp) {
P
pbrook 已提交
8960
            gen_exception(EXCP_SWI);
P
pbrook 已提交
8961 8962 8963
        } else {
            /* FIXME: Single stepping a WFI insn will not halt
               the CPU.  */
P
pbrook 已提交
8964
            gen_exception(EXCP_DEBUG);
P
pbrook 已提交
8965
        }
B
bellard 已提交
8966
    } else {
P
pbrook 已提交
8967 8968 8969 8970 8971 8972 8973 8974 8975
        /* While branches must always occur at the end of an IT block,
           there are a few other things that can cause us to terminate
           the TB in the middel of an IT block:
            - Exception generating instructions (bkpt, swi, undefined).
            - Page boundaries.
            - Hardware watchpoints.
           Hardware breakpoints have already been handled and skip this code.
         */
        gen_set_condexec(dc);
B
bellard 已提交
8976 8977
        switch(dc->is_jmp) {
        case DISAS_NEXT:
8978
            gen_goto_tb(dc, 1, dc->pc);
B
bellard 已提交
8979 8980 8981 8982 8983
            break;
        default:
        case DISAS_JUMP:
        case DISAS_UPDATE:
            /* indicate that the hash table must be used to find the next TB */
B
bellard 已提交
8984
            tcg_gen_exit_tb(0);
B
bellard 已提交
8985 8986 8987 8988
            break;
        case DISAS_TB_JUMP:
            /* nothing more to generate */
            break;
P
pbrook 已提交
8989
        case DISAS_WFI:
P
pbrook 已提交
8990
            gen_helper_wfi();
P
pbrook 已提交
8991 8992
            break;
        case DISAS_SWI:
P
pbrook 已提交
8993
            gen_exception(EXCP_SWI);
P
pbrook 已提交
8994
            break;
B
bellard 已提交
8995
        }
8996 8997
        if (dc->condjmp) {
            gen_set_label(dc->condlabel);
P
pbrook 已提交
8998
            gen_set_condexec(dc);
8999
            gen_goto_tb(dc, 1, dc->pc);
9000 9001
            dc->condjmp = 0;
        }
B
bellard 已提交
9002
    }
P
pbrook 已提交
9003

P
pbrook 已提交
9004
done_generating:
P
pbrook 已提交
9005
    gen_icount_end(tb, num_insns);
B
bellard 已提交
9006 9007 9008
    *gen_opc_ptr = INDEX_op_end;

#ifdef DEBUG_DISAS
9009
    if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
9010 9011 9012 9013
        qemu_log("----------------\n");
        qemu_log("IN: %s\n", lookup_symbol(pc_start));
        log_target_disas(pc_start, dc->pc - pc_start, env->thumb);
        qemu_log("\n");
B
bellard 已提交
9014 9015
    }
#endif
B
bellard 已提交
9016 9017 9018 9019 9020 9021
    if (search_pc) {
        j = gen_opc_ptr - gen_opc_buf;
        lj++;
        while (lj <= j)
            gen_opc_instr_start[lj++] = 0;
    } else {
B
bellard 已提交
9022
        tb->size = dc->pc - pc_start;
P
pbrook 已提交
9023
        tb->icount = num_insns;
B
bellard 已提交
9024
    }
B
bellard 已提交
9025 9026
}

9027
void gen_intermediate_code(CPUState *env, TranslationBlock *tb)
B
bellard 已提交
9028
{
9029
    gen_intermediate_code_internal(env, tb, 0);
B
bellard 已提交
9030 9031
}

9032
void gen_intermediate_code_pc(CPUState *env, TranslationBlock *tb)
B
bellard 已提交
9033
{
9034
    gen_intermediate_code_internal(env, tb, 1);
B
bellard 已提交
9035 9036
}

B
bellard 已提交
9037 9038 9039 9040
static const char *cpu_mode_names[16] = {
  "usr", "fiq", "irq", "svc", "???", "???", "???", "abt",
  "???", "???", "???", "und", "???", "???", "???", "sys"
};
P
pbrook 已提交
9041

9042
void cpu_dump_state(CPUState *env, FILE *f,
B
bellard 已提交
9043 9044
                    int (*cpu_fprintf)(FILE *f, const char *fmt, ...),
                    int flags)
B
bellard 已提交
9045 9046
{
    int i;
T
ths 已提交
9047
#if 0
B
bellard 已提交
9048
    union {
B
bellard 已提交
9049 9050 9051 9052
        uint32_t i;
        float s;
    } s0, s1;
    CPU_DoubleU d;
P
pbrook 已提交
9053 9054 9055 9056 9057 9058
    /* ??? This assumes float64 and double have the same layout.
       Oh well, it's only debug dumps.  */
    union {
        float64 f64;
        double d;
    } d0;
T
ths 已提交
9059
#endif
B
bellard 已提交
9060
    uint32_t psr;
B
bellard 已提交
9061 9062

    for(i=0;i<16;i++) {
B
bellard 已提交
9063
        cpu_fprintf(f, "R%02d=%08x", i, env->regs[i]);
B
bellard 已提交
9064
        if ((i % 4) == 3)
B
bellard 已提交
9065
            cpu_fprintf(f, "\n");
B
bellard 已提交
9066
        else
B
bellard 已提交
9067
            cpu_fprintf(f, " ");
B
bellard 已提交
9068
    }
B
bellard 已提交
9069
    psr = cpsr_read(env);
9070 9071
    cpu_fprintf(f, "PSR=%08x %c%c%c%c %c %s%d\n",
                psr,
B
bellard 已提交
9072 9073 9074 9075
                psr & (1 << 31) ? 'N' : '-',
                psr & (1 << 30) ? 'Z' : '-',
                psr & (1 << 29) ? 'C' : '-',
                psr & (1 << 28) ? 'V' : '-',
9076
                psr & CPSR_T ? 'T' : 'A',
B
bellard 已提交
9077
                cpu_mode_names[psr & 0xf], (psr & 0x10) ? 32 : 26);
B
bellard 已提交
9078

P
pbrook 已提交
9079
#if 0
B
bellard 已提交
9080
    for (i = 0; i < 16; i++) {
B
bellard 已提交
9081 9082 9083
        d.d = env->vfp.regs[i];
        s0.i = d.l.lower;
        s1.i = d.l.upper;
P
pbrook 已提交
9084 9085
        d0.f64 = d.d;
        cpu_fprintf(f, "s%02d=%08x(%8g) s%02d=%08x(%8g) d%02d=%08x%08x(%8g)\n",
B
bellard 已提交
9086
                    i * 2, (int)s0.i, s0.s,
P
pbrook 已提交
9087
                    i * 2 + 1, (int)s1.i, s1.s,
B
bellard 已提交
9088
                    i, (int)(uint32_t)d.l.upper, (int)(uint32_t)d.l.lower,
P
pbrook 已提交
9089
                    d0.d);
B
bellard 已提交
9090
    }
P
pbrook 已提交
9091
    cpu_fprintf(f, "FPSCR: %08x\n", (int)env->vfp.xregs[ARM_VFP_FPSCR]);
P
pbrook 已提交
9092
#endif
B
bellard 已提交
9093
}
B
bellard 已提交
9094

A
aurel32 已提交
9095 9096 9097 9098 9099
void gen_pc_load(CPUState *env, TranslationBlock *tb,
                unsigned long searched_pc, int pc_pos, void *puc)
{
    env->regs[15] = gen_opc_pc[pc_pos];
}