translate.c 302.2 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

P
pbrook 已提交
187 188 189 190 191 192 193 194 195 196 197 198
#define gen_set_cpsr(var, mask) gen_helper_cpsr_write(var, tcg_const_i32(mask))
/* 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 已提交
199 200 201 202
static void gen_smul_dual(TCGv a, TCGv b)
{
    TCGv tmp1 = new_tmp();
    TCGv tmp2 = new_tmp();
203 204
    tcg_gen_ext16s_i32(tmp1, a);
    tcg_gen_ext16s_i32(tmp2, b);
P
pbrook 已提交
205 206 207 208 209 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
    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 已提交
265 266
    tcg_gen_shli_i32(val, val, shift);
    tcg_gen_andi_i32(base, base, ~(mask << shift));
P
pbrook 已提交
267 268 269
    tcg_gen_or_i32(dest, base, val);
}

P
pbrook 已提交
270 271
/* Round the top 32 bits of a 64-bit value.  */
static void gen_roundqd(TCGv a, TCGv b)
P
pbrook 已提交
272
{
P
pbrook 已提交
273 274
    tcg_gen_shri_i32(a, a, 31);
    tcg_gen_add_i32(a, a, b);
P
pbrook 已提交
275 276
}

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

    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);
    return tmp1;
}

P
pbrook 已提交
293
static TCGv_i64 gen_muls_i64_i32(TCGv a, TCGv b)
P
pbrook 已提交
294
{
P
pbrook 已提交
295 296
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
297 298 299 300 301 302 303 304 305

    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);
    return tmp1;
}

P
pbrook 已提交
306
/* Unsigned 32x32->64 multiply.  */
307
static void gen_mull(TCGv a, TCGv b)
P
pbrook 已提交
308
{
P
pbrook 已提交
309 310
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
311

312 313
    tcg_gen_extu_i32_i64(tmp1, a);
    tcg_gen_extu_i32_i64(tmp2, b);
P
pbrook 已提交
314
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
315
    tcg_gen_trunc_i64_i32(a, tmp1);
P
pbrook 已提交
316
    tcg_gen_shri_i64(tmp1, tmp1, 32);
317
    tcg_gen_trunc_i64_i32(b, tmp1);
P
pbrook 已提交
318 319 320
}

/* Signed 32x32->64 multiply.  */
P
pbrook 已提交
321
static void gen_imull(TCGv a, TCGv b)
P
pbrook 已提交
322
{
P
pbrook 已提交
323 324
    TCGv_i64 tmp1 = tcg_temp_new_i64();
    TCGv_i64 tmp2 = tcg_temp_new_i64();
P
pbrook 已提交
325

P
pbrook 已提交
326 327
    tcg_gen_ext_i32_i64(tmp1, a);
    tcg_gen_ext_i32_i64(tmp2, b);
P
pbrook 已提交
328
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
P
pbrook 已提交
329
    tcg_gen_trunc_i64_i32(a, tmp1);
P
pbrook 已提交
330
    tcg_gen_shri_i64(tmp1, tmp1, 32);
P
pbrook 已提交
331 332 333
    tcg_gen_trunc_i64_i32(b, tmp1);
}

P
pbrook 已提交
334 335 336 337 338 339 340
/* 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 已提交
341
    dead_tmp(tmp);
P
pbrook 已提交
342 343
}

P
pbrook 已提交
344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363
/* 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 已提交
364 365
#define gen_set_CF(var) tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, CF))

P
pbrook 已提交
366 367 368 369 370
/* 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);
371
    gen_set_CF(tmp);
P
pbrook 已提交
372 373 374 375 376 377
    dead_tmp(tmp);
}

/* Set N and Z flags from var.  */
static inline void gen_logic_CC(TCGv var)
{
P
pbrook 已提交
378 379
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, NF));
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, ZF));
P
pbrook 已提交
380 381 382
}

/* T0 += T1 + CF.  */
383
static void gen_adc(TCGv t0, TCGv t1)
P
pbrook 已提交
384
{
P
pbrook 已提交
385
    TCGv tmp;
386
    tcg_gen_add_i32(t0, t0, t1);
P
pbrook 已提交
387
    tmp = load_cpu_field(CF);
388
    tcg_gen_add_i32(t0, t0, tmp);
P
pbrook 已提交
389 390 391
    dead_tmp(tmp);
}

392 393 394 395 396 397 398 399 400 401
/* 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 已提交
402 403 404
/* dest = T0 - T1 + CF - 1.  */
static void gen_sub_carry(TCGv dest, TCGv t0, TCGv t1)
{
P
pbrook 已提交
405
    TCGv tmp;
P
pbrook 已提交
406
    tcg_gen_sub_i32(dest, t0, t1);
P
pbrook 已提交
407
    tmp = load_cpu_field(CF);
P
pbrook 已提交
408 409 410 411 412
    tcg_gen_add_i32(dest, dest, tmp);
    tcg_gen_subi_i32(dest, dest, 1);
    dead_tmp(tmp);
}

P
pbrook 已提交
413 414
/* T0 &= ~T1.  Clobbers T1.  */
/* FIXME: Implement bic natively.  */
P
pbrook 已提交
415 416 417 418 419 420 421
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 已提交
422

P
pbrook 已提交
423 424 425
/* FIXME:  Implement this natively.  */
#define tcg_gen_abs_i32(t0, t1) gen_helper_abs(t0, t1)

P
pbrook 已提交
426 427 428 429 430 431 432 433 434 435 436 437 438 439 440
/* 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 已提交
441
static void shifter_out_im(TCGv var, int shift)
P
pbrook 已提交
442
{
P
pbrook 已提交
443 444 445
    TCGv tmp = new_tmp();
    if (shift == 0) {
        tcg_gen_andi_i32(tmp, var, 1);
P
pbrook 已提交
446
    } else {
P
pbrook 已提交
447
        tcg_gen_shri_i32(tmp, var, shift);
448
        if (shift != 31)
P
pbrook 已提交
449 450 451 452 453
            tcg_gen_andi_i32(tmp, tmp, 1);
    }
    gen_set_CF(tmp);
    dead_tmp(tmp);
}
P
pbrook 已提交
454

P
pbrook 已提交
455 456 457 458 459 460 461 462 463 464 465 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
/* 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 已提交
494
            TCGv tmp = load_cpu_field(CF);
P
pbrook 已提交
495 496 497
            if (flags)
                shifter_out_im(var, 0);
            tcg_gen_shri_i32(var, var, 1);
P
pbrook 已提交
498 499 500 501 502 503 504
            tcg_gen_shli_i32(tmp, tmp, 31);
            tcg_gen_or_i32(var, var, tmp);
            dead_tmp(tmp);
        }
    }
};

P
pbrook 已提交
505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525
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 已提交
526 527 528 529 530 531 532 533 534
#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 已提交
535
static void gen_arm_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
P
pbrook 已提交
536
{
P
pbrook 已提交
537
    TCGv_ptr tmp;
P
pbrook 已提交
538 539 540 541

    switch (op1) {
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
    case 1:
P
pbrook 已提交
542
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
543 544 545 546
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(s)
        break;
    case 5:
P
pbrook 已提交
547
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(u)
        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 已提交
568 569
#undef PAS_OP

P
pbrook 已提交
570 571 572 573 574 575 576 577 578 579
/* 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 已提交
580
static void gen_thumb2_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
P
pbrook 已提交
581
{
P
pbrook 已提交
582
    TCGv_ptr tmp;
P
pbrook 已提交
583 584 585 586

    switch (op1) {
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
    case 0:
P
pbrook 已提交
587
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
588 589 590 591
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(s)
        break;
    case 4:
P
pbrook 已提交
592
        tmp = tcg_temp_new_ptr();
P
pbrook 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
        PAS_OP(u)
        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 已提交
613 614
#undef PAS_OP

P
pbrook 已提交
615 616 617 618 619 620 621 622
static void gen_test_cc(int cc, int label)
{
    TCGv tmp;
    TCGv tmp2;
    int inv;

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

713
static const uint8_t table_logic_cc[16] = {
B
bellard 已提交
714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
    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 */
};
731

P
pbrook 已提交
732 733
/* Set PC and Thumb state from an immediate address.  */
static inline void gen_bx_im(DisasContext *s, uint32_t addr)
B
bellard 已提交
734
{
P
pbrook 已提交
735
    TCGv tmp;
B
bellard 已提交
736

P
pbrook 已提交
737
    s->is_jmp = DISAS_UPDATE;
P
pbrook 已提交
738
    if (s->thumb != (addr & 1)) {
739
        tmp = new_tmp();
P
pbrook 已提交
740 741
        tcg_gen_movi_i32(tmp, addr & 1);
        tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUState, thumb));
742
        dead_tmp(tmp);
P
pbrook 已提交
743
    }
744
    tcg_gen_movi_i32(cpu_R[15], addr & ~1);
P
pbrook 已提交
745 746 747 748 749 750
}

/* 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;
751 752 753
    tcg_gen_andi_i32(cpu_R[15], var, ~1);
    tcg_gen_andi_i32(var, var, 1);
    store_cpu_field(var, thumb);
P
pbrook 已提交
754 755
}

756 757 758 759 760 761 762 763 764 765 766 767 768
/* 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 已提交
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 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
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 已提交
814

P
pbrook 已提交
815 816
static inline void gen_set_pc_im(uint32_t val)
{
817
    tcg_gen_movi_i32(cpu_R[15], val);
P
pbrook 已提交
818 819
}

B
bellard 已提交
820 821 822
/* Force a TB lookup after an instruction that changes the CPU state.  */
static inline void gen_lookup_tb(DisasContext *s)
{
823
    tcg_gen_movi_i32(cpu_R[15], s->pc & ~1);
B
bellard 已提交
824 825 826
    s->is_jmp = DISAS_UPDATE;
}

P
pbrook 已提交
827 828
static inline void gen_add_data_offset(DisasContext *s, unsigned int insn,
                                       TCGv var)
B
bellard 已提交
829
{
B
bellard 已提交
830
    int val, rm, shift, shiftop;
P
pbrook 已提交
831
    TCGv offset;
B
bellard 已提交
832 833 834 835 836 837

    if (!(insn & (1 << 25))) {
        /* immediate */
        val = insn & 0xfff;
        if (!(insn & (1 << 23)))
            val = -val;
B
bellard 已提交
838
        if (val != 0)
P
pbrook 已提交
839
            tcg_gen_addi_i32(var, var, val);
B
bellard 已提交
840 841 842 843
    } else {
        /* shift/register */
        rm = (insn) & 0xf;
        shift = (insn >> 7) & 0x1f;
B
bellard 已提交
844
        shiftop = (insn >> 5) & 3;
P
pbrook 已提交
845
        offset = load_reg(s, rm);
P
pbrook 已提交
846
        gen_arm_shift_im(offset, shiftop, shift, 0);
B
bellard 已提交
847
        if (!(insn & (1 << 23)))
P
pbrook 已提交
848
            tcg_gen_sub_i32(var, var, offset);
B
bellard 已提交
849
        else
P
pbrook 已提交
850
            tcg_gen_add_i32(var, var, offset);
P
pbrook 已提交
851
        dead_tmp(offset);
B
bellard 已提交
852 853 854
    }
}

P
pbrook 已提交
855
static inline void gen_add_datah_offset(DisasContext *s, unsigned int insn,
P
pbrook 已提交
856
                                        int extra, TCGv var)
B
bellard 已提交
857 858
{
    int val, rm;
P
pbrook 已提交
859
    TCGv offset;
860

B
bellard 已提交
861 862 863 864 865
    if (insn & (1 << 22)) {
        /* immediate */
        val = (insn & 0xf) | ((insn >> 4) & 0xf0);
        if (!(insn & (1 << 23)))
            val = -val;
866
        val += extra;
B
bellard 已提交
867
        if (val != 0)
P
pbrook 已提交
868
            tcg_gen_addi_i32(var, var, val);
B
bellard 已提交
869 870
    } else {
        /* register */
P
pbrook 已提交
871
        if (extra)
P
pbrook 已提交
872
            tcg_gen_addi_i32(var, var, extra);
B
bellard 已提交
873
        rm = (insn) & 0xf;
P
pbrook 已提交
874
        offset = load_reg(s, rm);
B
bellard 已提交
875
        if (!(insn & (1 << 23)))
P
pbrook 已提交
876
            tcg_gen_sub_i32(var, var, offset);
B
bellard 已提交
877
        else
P
pbrook 已提交
878
            tcg_gen_add_i32(var, var, offset);
P
pbrook 已提交
879
        dead_tmp(offset);
B
bellard 已提交
880 881 882
    }
}

P
pbrook 已提交
883 884 885 886 887 888 889
#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 已提交
890 891
}

P
pbrook 已提交
892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 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
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 已提交
942
        tcg_gen_movi_i64(cpu_F1d, 0);
P
pbrook 已提交
943
    else
B
balrog 已提交
944
        tcg_gen_movi_i32(cpu_F1s, 0);
P
pbrook 已提交
945 946 947 948 949 950 951 952 953 954 955 956 957
}

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)
958
        gen_helper_vfp_sitod(cpu_F0d, cpu_F0s, cpu_env);
P
pbrook 已提交
959
    else
960
        gen_helper_vfp_sitos(cpu_F0s, cpu_F0s, cpu_env);
P
pbrook 已提交
961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987
}

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 已提交
988 989
{
    if (dp)
P
pbrook 已提交
990
        gen_helper_vfp_tosizd(cpu_F0s, cpu_F0d, cpu_env);
P
pbrook 已提交
991
    else
P
pbrook 已提交
992 993 994 995 996 997 998 999 1000 1001
        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) \
{ \
    if (dp) \
        gen_helper_vfp_##name##d(cpu_F0d, cpu_F0d, tcg_const_i32(shift), cpu_env);\
    else \
        gen_helper_vfp_##name##s(cpu_F0s, cpu_F0s, tcg_const_i32(shift), cpu_env);\
P
pbrook 已提交
1002
}
P
pbrook 已提交
1003 1004 1005 1006 1007 1008 1009 1010 1011
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 已提交
1012

1013
static inline void gen_vfp_ld(DisasContext *s, int dp, TCGv addr)
B
bellard 已提交
1014 1015
{
    if (dp)
1016
        tcg_gen_qemu_ld64(cpu_F0d, addr, IS_USER(s));
B
bellard 已提交
1017
    else
1018
        tcg_gen_qemu_ld32u(cpu_F0s, addr, IS_USER(s));
B
bellard 已提交
1019 1020
}

1021
static inline void gen_vfp_st(DisasContext *s, int dp, TCGv addr)
B
bellard 已提交
1022 1023
{
    if (dp)
1024
        tcg_gen_qemu_st64(cpu_F0d, addr, IS_USER(s));
B
bellard 已提交
1025
    else
1026
        tcg_gen_qemu_st32(cpu_F0s, addr, IS_USER(s));
B
bellard 已提交
1027 1028
}

B
bellard 已提交
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041
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 已提交
1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052

/* 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 已提交
1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065
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 已提交
1066
static inline void neon_load_reg64(TCGv_i64 var, int reg)
P
pbrook 已提交
1067 1068 1069 1070
{
    tcg_gen_ld_i64(var, cpu_env, vfp_reg_offset(1, reg));
}

P
pbrook 已提交
1071
static inline void neon_store_reg64(TCGv_i64 var, int reg)
P
pbrook 已提交
1072 1073 1074 1075
{
    tcg_gen_st_i64(var, cpu_env, vfp_reg_offset(1, reg));
}

P
pbrook 已提交
1076 1077 1078 1079 1080
#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 已提交
1081 1082 1083
static inline void gen_mov_F0_vreg(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1084
        tcg_gen_ld_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1085
    else
P
pbrook 已提交
1086
        tcg_gen_ld_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1087 1088 1089 1090 1091
}

static inline void gen_mov_F1_vreg(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1092
        tcg_gen_ld_f64(cpu_F1d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1093
    else
P
pbrook 已提交
1094
        tcg_gen_ld_f32(cpu_F1s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1095 1096 1097 1098 1099
}

static inline void gen_mov_vreg_F0(int dp, int reg)
{
    if (dp)
P
pbrook 已提交
1100
        tcg_gen_st_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1101
    else
P
pbrook 已提交
1102
        tcg_gen_st_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
B
bellard 已提交
1103 1104
}

1105 1106
#define ARM_CP_RW_BIT	(1 << 20)

P
pbrook 已提交
1107
static inline void iwmmxt_load_reg(TCGv_i64 var, int reg)
P
pbrook 已提交
1108 1109 1110 1111
{
    tcg_gen_ld_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
}

P
pbrook 已提交
1112
static inline void iwmmxt_store_reg(TCGv_i64 var, int reg)
P
pbrook 已提交
1113 1114 1115 1116
{
    tcg_gen_st_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
}

1117
static inline TCGv iwmmxt_load_creg(int reg)
P
pbrook 已提交
1118
{
1119 1120 1121
    TCGv var = new_tmp();
    tcg_gen_ld_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
    return var;
P
pbrook 已提交
1122 1123
}

1124
static inline void iwmmxt_store_creg(int reg, TCGv var)
P
pbrook 已提交
1125
{
1126
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
P
pbrook 已提交
1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 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
}

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 已提交
1265
    tcg_gen_ext32u_i64(cpu_V1, cpu_V1);
P
pbrook 已提交
1266 1267 1268
    tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
}

1269
static inline int gen_iwmmxt_address(DisasContext *s, uint32_t insn, TCGv dest)
1270 1271 1272
{
    int rd;
    uint32_t offset;
1273
    TCGv tmp;
1274 1275

    rd = (insn >> 16) & 0xf;
1276
    tmp = load_reg(s, rd);
1277 1278 1279 1280 1281

    offset = (insn & 0xff) << ((insn >> 7) & 2);
    if (insn & (1 << 24)) {
        /* Pre indexed */
        if (insn & (1 << 23))
1282
            tcg_gen_addi_i32(tmp, tmp, offset);
1283
        else
1284 1285
            tcg_gen_addi_i32(tmp, tmp, -offset);
        tcg_gen_mov_i32(dest, tmp);
1286
        if (insn & (1 << 21))
1287 1288 1289
            store_reg(s, rd, tmp);
        else
            dead_tmp(tmp);
1290 1291
    } else if (insn & (1 << 21)) {
        /* Post indexed */
1292
        tcg_gen_mov_i32(dest, tmp);
1293
        if (insn & (1 << 23))
1294
            tcg_gen_addi_i32(tmp, tmp, offset);
1295
        else
1296 1297
            tcg_gen_addi_i32(tmp, tmp, -offset);
        store_reg(s, rd, tmp);
1298 1299 1300 1301 1302
    } else if (!(insn & (1 << 23)))
        return 1;
    return 0;
}

1303
static inline int gen_iwmmxt_shift(uint32_t insn, uint32_t mask, TCGv dest)
1304 1305
{
    int rd = (insn >> 0) & 0xf;
1306
    TCGv tmp;
1307

1308 1309
    if (insn & (1 << 8)) {
        if (rd < ARM_IWMMXT_wCGR0 || rd > ARM_IWMMXT_wCGR3) {
1310
            return 1;
1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
        } 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);
1322 1323 1324 1325 1326 1327 1328 1329 1330
    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;
1331 1332
    TCGv addr;
    TCGv tmp, tmp2, tmp3;
1333 1334 1335 1336 1337 1338 1339

    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 */
1340 1341 1342 1343
                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);
1344
            } else {					/* TMCRR */
1345 1346
                tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
                iwmmxt_store_reg(cpu_V0, wrd);
1347 1348 1349 1350 1351 1352
                gen_op_iwmmxt_set_mup();
            }
            return 0;
        }

        wrd = (insn >> 12) & 0xf;
1353 1354 1355
        addr = new_tmp();
        if (gen_iwmmxt_address(s, insn, addr)) {
            dead_tmp(addr);
1356
            return 1;
1357
        }
1358 1359
        if (insn & ARM_CP_RW_BIT) {
            if ((insn >> 28) == 0xf) {			/* WLDRW wCx */
1360 1361 1362
                tmp = new_tmp();
                tcg_gen_qemu_ld32u(tmp, addr, IS_USER(s));
                iwmmxt_store_creg(wrd, tmp);
1363
            } else {
P
pbrook 已提交
1364 1365 1366
                i = 1;
                if (insn & (1 << 8)) {
                    if (insn & (1 << 22)) {		/* WLDRD */
1367
                        tcg_gen_qemu_ld64(cpu_M0, addr, IS_USER(s));
P
pbrook 已提交
1368 1369
                        i = 0;
                    } else {				/* WLDRW wRd */
1370
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
1371 1372 1373
                    }
                } else {
                    if (insn & (1 << 22)) {		/* WLDRH */
1374
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
1375
                    } else {				/* WLDRB */
1376
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
1377 1378 1379 1380 1381 1382
                    }
                }
                if (i) {
                    tcg_gen_extu_i32_i64(cpu_M0, tmp);
                    dead_tmp(tmp);
                }
1383 1384 1385 1386
                gen_op_iwmmxt_movq_wRn_M0(wrd);
            }
        } else {
            if ((insn >> 28) == 0xf) {			/* WSTRW wCx */
1387 1388
                tmp = iwmmxt_load_creg(wrd);
                gen_st32(tmp, addr, IS_USER(s));
1389 1390
            } else {
                gen_op_iwmmxt_movq_M0_wRn(wrd);
P
pbrook 已提交
1391 1392 1393 1394
                tmp = new_tmp();
                if (insn & (1 << 8)) {
                    if (insn & (1 << 22)) {		/* WSTRD */
                        dead_tmp(tmp);
1395
                        tcg_gen_qemu_st64(cpu_M0, addr, IS_USER(s));
P
pbrook 已提交
1396 1397
                    } else {				/* WSTRW wRd */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1398
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
1399 1400 1401 1402
                    }
                } else {
                    if (insn & (1 << 22)) {		/* WSTRH */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1403
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
1404 1405
                    } else {				/* WSTRB */
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1406
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
1407 1408
                    }
                }
1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441
            }
        }
        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:
1442 1443 1444 1445 1446
            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);
1447 1448 1449 1450 1451 1452
            break;
        case ARM_IWMMXT_wCGR0:
        case ARM_IWMMXT_wCGR1:
        case ARM_IWMMXT_wCGR2:
        case ARM_IWMMXT_wCGR3:
            gen_op_iwmmxt_set_cup();
1453 1454
            tmp = load_reg(s, rd);
            iwmmxt_store_creg(wrd, tmp);
1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475
            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;
1476 1477
        tmp = iwmmxt_load_creg(wrd);
        store_reg(s, rd, tmp);
1478 1479 1480 1481 1482 1483
        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 已提交
1484
        tcg_gen_neg_i64(cpu_M0, cpu_M0);
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 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
        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 已提交
1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
        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);
        }
1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600
        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 已提交
1601 1602
            iwmmxt_load_reg(cpu_V1, wrd);
            tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633
        }
        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 已提交
1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
        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);
        }
1645 1646 1647 1648 1649 1650 1651 1652 1653
        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);
1654 1655 1656 1657 1658
        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);
1659 1660 1661 1662
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x601: case 0x605: case 0x609: case 0x60d:	/* TINSR */
1663 1664
        if (((insn >> 6) & 3) == 3)
            return 1;
1665 1666
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1667
        tmp = load_reg(s, rd);
1668 1669 1670
        gen_op_iwmmxt_movq_M0_wRn(wrd);
        switch ((insn >> 6) & 3) {
        case 0:
1671 1672
            tmp2 = tcg_const_i32(0xff);
            tmp3 = tcg_const_i32((insn & 7) << 3);
1673 1674
            break;
        case 1:
1675 1676
            tmp2 = tcg_const_i32(0xffff);
            tmp3 = tcg_const_i32((insn & 3) << 4);
1677 1678
            break;
        case 2:
1679 1680
            tmp2 = tcg_const_i32(0xffffffff);
            tmp3 = tcg_const_i32((insn & 1) << 5);
1681
            break;
1682 1683 1684
        default:
            TCGV_UNUSED(tmp2);
            TCGV_UNUSED(tmp3);
1685
        }
1686 1687 1688 1689
        gen_helper_iwmmxt_insr(cpu_M0, cpu_M0, tmp, tmp2, tmp3);
        tcg_temp_free(tmp3);
        tcg_temp_free(tmp2);
        dead_tmp(tmp);
1690 1691 1692 1693 1694 1695
        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;
1696
        if (rd == 15 || ((insn >> 22) & 3) == 3)
1697 1698
            return 1;
        gen_op_iwmmxt_movq_M0_wRn(wrd);
1699
        tmp = new_tmp();
1700 1701
        switch ((insn >> 22) & 3) {
        case 0:
1702 1703 1704 1705 1706 1707
            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);
1708 1709 1710
            }
            break;
        case 1:
1711 1712 1713 1714 1715 1716
            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);
1717 1718 1719
            }
            break;
        case 2:
1720 1721
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 1) << 5);
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1722 1723
            break;
        }
1724
        store_reg(s, rd, tmp);
1725 1726
        break;
    case 0x117: case 0x517: case 0x917: case 0xd17:	/* TEXTRC */
1727
        if ((insn & 0x000ff008) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1728
            return 1;
1729
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
1730 1731
        switch ((insn >> 22) & 3) {
        case 0:
1732
            tcg_gen_shri_i32(tmp, tmp, ((insn & 7) << 2) + 0);
1733 1734
            break;
        case 1:
1735
            tcg_gen_shri_i32(tmp, tmp, ((insn & 3) << 3) + 4);
1736 1737
            break;
        case 2:
1738
            tcg_gen_shri_i32(tmp, tmp, ((insn & 1) << 4) + 12);
1739 1740
            break;
        }
1741 1742 1743
        tcg_gen_shli_i32(tmp, tmp, 28);
        gen_set_nzcv(tmp);
        dead_tmp(tmp);
1744 1745
        break;
    case 0x401: case 0x405: case 0x409: case 0x40d:	/* TBCST */
1746 1747
        if (((insn >> 6) & 3) == 3)
            return 1;
1748 1749
        rd = (insn >> 12) & 0xf;
        wrd = (insn >> 16) & 0xf;
1750
        tmp = load_reg(s, rd);
1751 1752
        switch ((insn >> 6) & 3) {
        case 0:
1753
            gen_helper_iwmmxt_bcstb(cpu_M0, tmp);
1754 1755
            break;
        case 1:
1756
            gen_helper_iwmmxt_bcstw(cpu_M0, tmp);
1757 1758
            break;
        case 2:
1759
            gen_helper_iwmmxt_bcstl(cpu_M0, tmp);
1760 1761
            break;
        }
1762
        dead_tmp(tmp);
1763 1764 1765 1766
        gen_op_iwmmxt_movq_wRn_M0(wrd);
        gen_op_iwmmxt_set_mup();
        break;
    case 0x113: case 0x513: case 0x913: case 0xd13:	/* TANDC */
1767
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1768
            return 1;
1769 1770 1771
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
        tmp2 = new_tmp();
        tcg_gen_mov_i32(tmp2, tmp);
1772 1773 1774
        switch ((insn >> 22) & 3) {
        case 0:
            for (i = 0; i < 7; i ++) {
1775 1776
                tcg_gen_shli_i32(tmp2, tmp2, 4);
                tcg_gen_and_i32(tmp, tmp, tmp2);
1777 1778 1779 1780
            }
            break;
        case 1:
            for (i = 0; i < 3; i ++) {
1781 1782
                tcg_gen_shli_i32(tmp2, tmp2, 8);
                tcg_gen_and_i32(tmp, tmp, tmp2);
1783 1784 1785
            }
            break;
        case 2:
1786 1787
            tcg_gen_shli_i32(tmp2, tmp2, 16);
            tcg_gen_and_i32(tmp, tmp, tmp2);
1788 1789
            break;
        }
1790 1791 1792
        gen_set_nzcv(tmp);
        dead_tmp(tmp2);
        dead_tmp(tmp);
1793 1794 1795 1796 1797 1798 1799
        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 已提交
1800
            gen_helper_iwmmxt_addcb(cpu_M0, cpu_M0);
1801 1802
            break;
        case 1:
P
pbrook 已提交
1803
            gen_helper_iwmmxt_addcw(cpu_M0, cpu_M0);
1804 1805
            break;
        case 2:
P
pbrook 已提交
1806
            gen_helper_iwmmxt_addcl(cpu_M0, cpu_M0);
1807 1808 1809 1810 1811 1812 1813 1814
            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 */
1815
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1816
            return 1;
1817 1818 1819
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
        tmp2 = new_tmp();
        tcg_gen_mov_i32(tmp2, tmp);
1820 1821 1822
        switch ((insn >> 22) & 3) {
        case 0:
            for (i = 0; i < 7; i ++) {
1823 1824
                tcg_gen_shli_i32(tmp2, tmp2, 4);
                tcg_gen_or_i32(tmp, tmp, tmp2);
1825 1826 1827 1828
            }
            break;
        case 1:
            for (i = 0; i < 3; i ++) {
1829 1830
                tcg_gen_shli_i32(tmp2, tmp2, 8);
                tcg_gen_or_i32(tmp, tmp, tmp2);
1831 1832 1833
            }
            break;
        case 2:
1834 1835
            tcg_gen_shli_i32(tmp2, tmp2, 16);
            tcg_gen_or_i32(tmp, tmp, tmp2);
1836 1837
            break;
        }
1838 1839 1840
        gen_set_nzcv(tmp);
        dead_tmp(tmp2);
        dead_tmp(tmp);
1841 1842 1843 1844
        break;
    case 0x103: case 0x503: case 0x903: case 0xd03:	/* TMOVMSK */
        rd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
1845
        if ((insn & 0xf) != 0 || ((insn >> 22) & 3) == 3)
1846 1847
            return 1;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1848
        tmp = new_tmp();
1849 1850
        switch ((insn >> 22) & 3) {
        case 0:
1851
            gen_helper_iwmmxt_msbb(tmp, cpu_M0);
1852 1853
            break;
        case 1:
1854
            gen_helper_iwmmxt_msbw(tmp, cpu_M0);
1855 1856
            break;
        case 2:
1857
            gen_helper_iwmmxt_msbl(tmp, cpu_M0);
1858 1859
            break;
        }
1860
        store_reg(s, rd, tmp);
1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 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
        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:
1958 1959
        if (((insn >> 22) & 3) == 0)
            return 1;
1960 1961 1962
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1963 1964 1965
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
1966
            return 1;
1967
        }
1968 1969
        switch ((insn >> 22) & 3) {
        case 1:
1970
            gen_helper_iwmmxt_srlw(cpu_M0, cpu_env, cpu_M0, tmp);
1971 1972
            break;
        case 2:
1973
            gen_helper_iwmmxt_srll(cpu_M0, cpu_env, cpu_M0, tmp);
1974 1975
            break;
        case 3:
1976
            gen_helper_iwmmxt_srlq(cpu_M0, cpu_env, cpu_M0, tmp);
1977 1978
            break;
        }
1979
        dead_tmp(tmp);
1980 1981 1982 1983 1984 1985
        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:
1986 1987
        if (((insn >> 22) & 3) == 0)
            return 1;
1988 1989 1990
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1991 1992 1993
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
1994
            return 1;
1995
        }
1996 1997
        switch ((insn >> 22) & 3) {
        case 1:
1998
            gen_helper_iwmmxt_sraw(cpu_M0, cpu_env, cpu_M0, tmp);
1999 2000
            break;
        case 2:
2001
            gen_helper_iwmmxt_sral(cpu_M0, cpu_env, cpu_M0, tmp);
2002 2003
            break;
        case 3:
2004
            gen_helper_iwmmxt_sraq(cpu_M0, cpu_env, cpu_M0, tmp);
2005 2006
            break;
        }
2007
        dead_tmp(tmp);
2008 2009 2010 2011 2012 2013
        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:
2014 2015
        if (((insn >> 22) & 3) == 0)
            return 1;
2016 2017 2018
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2019 2020 2021
        tmp = new_tmp();
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
            dead_tmp(tmp);
2022
            return 1;
2023
        }
2024 2025
        switch ((insn >> 22) & 3) {
        case 1:
2026
            gen_helper_iwmmxt_sllw(cpu_M0, cpu_env, cpu_M0, tmp);
2027 2028
            break;
        case 2:
2029
            gen_helper_iwmmxt_slll(cpu_M0, cpu_env, cpu_M0, tmp);
2030 2031
            break;
        case 3:
2032
            gen_helper_iwmmxt_sllq(cpu_M0, cpu_env, cpu_M0, tmp);
2033 2034
            break;
        }
2035
        dead_tmp(tmp);
2036 2037 2038 2039 2040 2041
        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:
2042 2043
        if (((insn >> 22) & 3) == 0)
            return 1;
2044 2045 2046
        wrd = (insn >> 12) & 0xf;
        rd0 = (insn >> 16) & 0xf;
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2047
        tmp = new_tmp();
2048 2049
        switch ((insn >> 22) & 3) {
        case 1:
2050 2051
            if (gen_iwmmxt_shift(insn, 0xf, tmp)) {
                dead_tmp(tmp);
2052
                return 1;
2053 2054
            }
            gen_helper_iwmmxt_rorw(cpu_M0, cpu_env, cpu_M0, tmp);
2055 2056
            break;
        case 2:
2057 2058
            if (gen_iwmmxt_shift(insn, 0x1f, tmp)) {
                dead_tmp(tmp);
2059
                return 1;
2060 2061
            }
            gen_helper_iwmmxt_rorl(cpu_M0, cpu_env, cpu_M0, tmp);
2062 2063
            break;
        case 3:
2064 2065
            if (gen_iwmmxt_shift(insn, 0x3f, tmp)) {
                dead_tmp(tmp);
2066
                return 1;
2067 2068
            }
            gen_helper_iwmmxt_rorq(cpu_M0, cpu_env, cpu_M0, tmp);
2069 2070
            break;
        }
2071
        dead_tmp(tmp);
2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 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
        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);
2144 2145 2146 2147
        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);
2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 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
        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);
2201 2202 2203
        tmp = tcg_const_i32(((insn >> 16) & 0xf0) | (insn & 0x0f));
        gen_helper_iwmmxt_shufh(cpu_M0, cpu_env, cpu_M0, tmp);
        tcg_temp_free(tmp);
2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 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
        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:
2255 2256
        if (!(insn & (1 << 20)) || ((insn >> 22) & 3) == 0)
            return 1;
2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294
        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);
2295 2296
        tmp = load_reg(s, rd0);
        tmp2 = load_reg(s, rd1);
2297 2298
        switch ((insn >> 16) & 0xf) {
        case 0x0:					/* TMIA */
2299
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2300 2301
            break;
        case 0x8:					/* TMIAPH */
2302
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2303 2304 2305
            break;
        case 0xc: case 0xd: case 0xe: case 0xf:		/* TMIAxy */
            if (insn & (1 << 16))
2306
                tcg_gen_shri_i32(tmp, tmp, 16);
2307
            if (insn & (1 << 17))
2308 2309
                tcg_gen_shri_i32(tmp2, tmp2, 16);
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2310 2311
            break;
        default:
2312 2313
            dead_tmp(tmp2);
            dead_tmp(tmp);
2314 2315
            return 1;
        }
2316 2317
        dead_tmp(tmp2);
        dead_tmp(tmp);
2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332
        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;
2333
    TCGv tmp, tmp2;
2334 2335 2336 2337 2338 2339 2340 2341 2342 2343

    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;

2344 2345
        tmp = load_reg(s, rd0);
        tmp2 = load_reg(s, rd1);
2346 2347
        switch ((insn >> 16) & 0xf) {
        case 0x0:					/* MIA */
2348
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2349 2350
            break;
        case 0x8:					/* MIAPH */
2351
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2352 2353 2354 2355 2356 2357
            break;
        case 0xc:					/* MIABB */
        case 0xd:					/* MIABT */
        case 0xe:					/* MIATB */
        case 0xf:					/* MIATT */
            if (insn & (1 << 16))
2358
                tcg_gen_shri_i32(tmp, tmp, 16);
2359
            if (insn & (1 << 17))
2360 2361
                tcg_gen_shri_i32(tmp2, tmp2, 16);
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2362 2363 2364 2365
            break;
        default:
            return 1;
        }
2366 2367
        dead_tmp(tmp2);
        dead_tmp(tmp);
2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382

        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 */
2383 2384 2385 2386 2387
            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);
2388
        } else {					/* MAR */
2389 2390
            tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
            iwmmxt_store_reg(cpu_V0, acc);
2391 2392 2393 2394 2395 2396 2397
        }
        return 0;
    }

    return 1;
}

2398 2399 2400 2401
/* Disassemble system coprocessor instruction.  Return nonzero if
   instruction is not defined.  */
static int disas_cp_insn(CPUState *env, DisasContext *s, uint32_t insn)
{
P
pbrook 已提交
2402
    TCGv tmp;
2403 2404 2405 2406 2407 2408
    uint32_t rd = (insn >> 12) & 0xf;
    uint32_t cp = (insn >> 8) & 0xf;
    if (IS_USER(s)) {
        return 1;
    }

2409
    if (insn & ARM_CP_RW_BIT) {
2410 2411
        if (!env->cp[cp].cp_read)
            return 1;
P
pbrook 已提交
2412 2413 2414 2415
        gen_set_pc_im(s->pc);
        tmp = new_tmp();
        gen_helper_get_cp(tmp, cpu_env, tcg_const_i32(insn));
        store_reg(s, rd, tmp);
2416 2417 2418
    } else {
        if (!env->cp[cp].cp_write)
            return 1;
P
pbrook 已提交
2419 2420 2421
        gen_set_pc_im(s->pc);
        tmp = load_reg(s, rd);
        gen_helper_set_cp(cpu_env, tcg_const_i32(insn), tmp);
B
balrog 已提交
2422
        dead_tmp(tmp);
2423 2424 2425 2426
    }
    return 0;
}

P
pbrook 已提交
2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446
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 已提交
2447 2448
/* Disassemble system coprocessor (cp15) instruction.  Return nonzero if
   instruction is not defined.  */
2449
static int disas_cp15_insn(CPUState *env, DisasContext *s, uint32_t insn)
B
bellard 已提交
2450 2451
{
    uint32_t rd;
P
pbrook 已提交
2452
    TCGv tmp;
B
bellard 已提交
2453

P
pbrook 已提交
2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470
    /* 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 已提交
2471 2472
        return 1;
    }
B
bellard 已提交
2473 2474 2475
    if ((insn & 0x0fff0fff) == 0x0e070f90
        || (insn & 0x0fff0fff) == 0x0e070f58) {
        /* Wait for interrupt.  */
P
pbrook 已提交
2476
        gen_set_pc_im(s->pc);
P
pbrook 已提交
2477
        s->is_jmp = DISAS_WFI;
B
bellard 已提交
2478 2479
        return 0;
    }
B
bellard 已提交
2480
    rd = (insn >> 12) & 0xf;
2481
    if (insn & ARM_CP_RW_BIT) {
P
pbrook 已提交
2482 2483
        tmp = new_tmp();
        gen_helper_get_cp15(tmp, cpu_env, tcg_const_i32(insn));
B
bellard 已提交
2484 2485
        /* If the destination register is r15 then sets condition codes.  */
        if (rd != 15)
P
pbrook 已提交
2486 2487 2488
            store_reg(s, rd, tmp);
        else
            dead_tmp(tmp);
B
bellard 已提交
2489
    } else {
P
pbrook 已提交
2490 2491 2492
        tmp = load_reg(s, rd);
        gen_helper_set_cp15(cpu_env, tcg_const_i32(insn), tmp);
        dead_tmp(tmp);
2493 2494 2495 2496 2497 2498
        /* 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 已提交
2499 2500 2501 2502
    }
    return 0;
}

P
pbrook 已提交
2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522
#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 已提交
2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536
/* 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 已提交
2537 2538 2539 2540 2541 2542
static inline int
vfp_enabled(CPUState * env)
{
    return ((env->vfp.xregs[ARM_VFP_FPEXC] & (1 << 30)) != 0);
}

P
pbrook 已提交
2543 2544 2545 2546 2547
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 已提交
2548
    tcg_gen_ext8u_i32(var, var);
P
pbrook 已提交
2549 2550 2551 2552 2553 2554 2555 2556 2557 2558
    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 已提交
2559
    tcg_gen_ext16u_i32(var, var);
P
pbrook 已提交
2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573
    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 已提交
2574 2575 2576 2577 2578 2579
/* 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;
2580
    TCGv addr;
P
pbrook 已提交
2581
    TCGv tmp;
P
pbrook 已提交
2582
    TCGv tmp2;
B
bellard 已提交
2583

P
pbrook 已提交
2584 2585 2586
    if (!arm_feature(env, ARM_FEATURE_VFP))
        return 1;

P
pbrook 已提交
2587 2588
    if (!vfp_enabled(env)) {
        /* VFP disabled.  Only allow fmxr/fmrx to/from some control regs.  */
P
pbrook 已提交
2589 2590 2591
        if ((insn & 0x0fe00fff) != 0x0ee00a10)
            return 1;
        rn = (insn >> 16) & 0xf;
P
pbrook 已提交
2592 2593
        if (rn != ARM_VFP_FPSID && rn != ARM_VFP_FPEXC
            && rn != ARM_VFP_MVFR1 && rn != ARM_VFP_MVFR0)
P
pbrook 已提交
2594 2595
            return 1;
    }
B
bellard 已提交
2596 2597 2598 2599 2600 2601 2602
    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 已提交
2603 2604 2605 2606 2607
                int size;
                int pass;

                VFP_DREG_N(rn, insn);
                if (insn & 0xf)
B
bellard 已提交
2608
                    return 1;
P
pbrook 已提交
2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623
                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;
                }
2624
                if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
2625
                    /* vfp->arm */
P
pbrook 已提交
2626
                    tmp = neon_load_reg(rn, pass);
P
pbrook 已提交
2627 2628 2629
                    switch (size) {
                    case 0:
                        if (offset)
P
pbrook 已提交
2630
                            tcg_gen_shri_i32(tmp, tmp, offset);
P
pbrook 已提交
2631
                        if (insn & (1 << 23))
P
pbrook 已提交
2632
                            gen_uxtb(tmp);
P
pbrook 已提交
2633
                        else
P
pbrook 已提交
2634
                            gen_sxtb(tmp);
P
pbrook 已提交
2635 2636 2637 2638
                        break;
                    case 1:
                        if (insn & (1 << 23)) {
                            if (offset) {
P
pbrook 已提交
2639
                                tcg_gen_shri_i32(tmp, tmp, 16);
P
pbrook 已提交
2640
                            } else {
P
pbrook 已提交
2641
                                gen_uxth(tmp);
P
pbrook 已提交
2642 2643 2644
                            }
                        } else {
                            if (offset) {
P
pbrook 已提交
2645
                                tcg_gen_sari_i32(tmp, tmp, 16);
P
pbrook 已提交
2646
                            } else {
P
pbrook 已提交
2647
                                gen_sxth(tmp);
P
pbrook 已提交
2648 2649 2650 2651 2652 2653
                            }
                        }
                        break;
                    case 2:
                        break;
                    }
P
pbrook 已提交
2654
                    store_reg(s, rd, tmp);
B
bellard 已提交
2655 2656
                } else {
                    /* arm->vfp */
P
pbrook 已提交
2657
                    tmp = load_reg(s, rd);
P
pbrook 已提交
2658 2659 2660
                    if (insn & (1 << 23)) {
                        /* VDUP */
                        if (size == 0) {
P
pbrook 已提交
2661
                            gen_neon_dup_u8(tmp, 0);
P
pbrook 已提交
2662
                        } else if (size == 1) {
P
pbrook 已提交
2663
                            gen_neon_dup_low16(tmp);
P
pbrook 已提交
2664
                        }
P
pbrook 已提交
2665 2666 2667 2668 2669 2670
                        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 已提交
2671 2672 2673 2674
                    } else {
                        /* VMOV */
                        switch (size) {
                        case 0:
P
pbrook 已提交
2675 2676 2677
                            tmp2 = neon_load_reg(rn, pass);
                            gen_bfi(tmp, tmp2, tmp, offset, 0xff);
                            dead_tmp(tmp2);
P
pbrook 已提交
2678 2679
                            break;
                        case 1:
P
pbrook 已提交
2680 2681 2682
                            tmp2 = neon_load_reg(rn, pass);
                            gen_bfi(tmp, tmp2, tmp, offset, 0xffff);
                            dead_tmp(tmp2);
P
pbrook 已提交
2683 2684 2685 2686
                            break;
                        case 2:
                            break;
                        }
P
pbrook 已提交
2687
                        neon_store_reg(rn, pass, tmp);
P
pbrook 已提交
2688
                    }
B
bellard 已提交
2689
                }
P
pbrook 已提交
2690 2691 2692 2693
            } else { /* !dp */
                if ((insn & 0x6f) != 0x00)
                    return 1;
                rn = VFP_SREG_N(insn);
2694
                if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
2695 2696 2697
                    /* vfp->arm */
                    if (insn & (1 << 21)) {
                        /* system register */
P
pbrook 已提交
2698
                        rn >>= 1;
P
pbrook 已提交
2699

B
bellard 已提交
2700
                        switch (rn) {
P
pbrook 已提交
2701
                        case ARM_VFP_FPSID:
P
pbrook 已提交
2702
                            /* VFP2 allows access to FSID from userspace.
P
pbrook 已提交
2703 2704 2705 2706 2707
                               VFP3 restricts all id registers to privileged
                               accesses.  */
                            if (IS_USER(s)
                                && arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2708
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2709
                            break;
P
pbrook 已提交
2710
                        case ARM_VFP_FPEXC:
P
pbrook 已提交
2711 2712
                            if (IS_USER(s))
                                return 1;
P
pbrook 已提交
2713
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2714
                            break;
P
pbrook 已提交
2715 2716
                        case ARM_VFP_FPINST:
                        case ARM_VFP_FPINST2:
P
pbrook 已提交
2717 2718 2719 2720
                            /* Not present in VFP3.  */
                            if (IS_USER(s)
                                || arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2721
                            tmp = load_cpu_field(vfp.xregs[rn]);
B
bellard 已提交
2722
                            break;
P
pbrook 已提交
2723
                        case ARM_VFP_FPSCR:
2724
                            if (rd == 15) {
P
pbrook 已提交
2725 2726 2727 2728 2729 2730
                                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 已提交
2731
                            break;
P
pbrook 已提交
2732 2733 2734 2735 2736
                        case ARM_VFP_MVFR0:
                        case ARM_VFP_MVFR1:
                            if (IS_USER(s)
                                || !arm_feature(env, ARM_FEATURE_VFP3))
                                return 1;
P
pbrook 已提交
2737
                            tmp = load_cpu_field(vfp.xregs[rn]);
P
pbrook 已提交
2738
                            break;
B
bellard 已提交
2739 2740 2741 2742 2743
                        default:
                            return 1;
                        }
                    } else {
                        gen_mov_F0_vreg(0, rn);
P
pbrook 已提交
2744
                        tmp = gen_vfp_mrs();
B
bellard 已提交
2745 2746
                    }
                    if (rd == 15) {
B
bellard 已提交
2747
                        /* Set the 4 flag bits in the CPSR.  */
P
pbrook 已提交
2748 2749 2750 2751 2752
                        gen_set_nzcv(tmp);
                        dead_tmp(tmp);
                    } else {
                        store_reg(s, rd, tmp);
                    }
B
bellard 已提交
2753 2754
                } else {
                    /* arm->vfp */
P
pbrook 已提交
2755
                    tmp = load_reg(s, rd);
B
bellard 已提交
2756
                    if (insn & (1 << 21)) {
P
pbrook 已提交
2757
                        rn >>= 1;
B
bellard 已提交
2758 2759
                        /* system register */
                        switch (rn) {
P
pbrook 已提交
2760
                        case ARM_VFP_FPSID:
P
pbrook 已提交
2761 2762
                        case ARM_VFP_MVFR0:
                        case ARM_VFP_MVFR1:
B
bellard 已提交
2763 2764
                            /* Writes are ignored.  */
                            break;
P
pbrook 已提交
2765
                        case ARM_VFP_FPSCR:
P
pbrook 已提交
2766 2767
                            gen_helper_vfp_set_fpscr(cpu_env, tmp);
                            dead_tmp(tmp);
B
bellard 已提交
2768
                            gen_lookup_tb(s);
B
bellard 已提交
2769
                            break;
P
pbrook 已提交
2770
                        case ARM_VFP_FPEXC:
P
pbrook 已提交
2771 2772
                            if (IS_USER(s))
                                return 1;
P
pbrook 已提交
2773
                            store_cpu_field(tmp, vfp.xregs[rn]);
P
pbrook 已提交
2774 2775 2776 2777
                            gen_lookup_tb(s);
                            break;
                        case ARM_VFP_FPINST:
                        case ARM_VFP_FPINST2:
P
pbrook 已提交
2778
                            store_cpu_field(tmp, vfp.xregs[rn]);
P
pbrook 已提交
2779
                            break;
B
bellard 已提交
2780 2781 2782 2783
                        default:
                            return 1;
                        }
                    } else {
P
pbrook 已提交
2784
                        gen_vfp_msr(tmp);
B
bellard 已提交
2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798
                        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 已提交
2799
                    VFP_DREG_N(rn, insn);
B
bellard 已提交
2800 2801 2802 2803
                }

                if (op == 15 && (rn == 15 || rn > 17)) {
                    /* Integer or single precision destination.  */
P
pbrook 已提交
2804
                    rd = VFP_SREG_D(insn);
B
bellard 已提交
2805
                } else {
P
pbrook 已提交
2806
                    VFP_DREG_D(rd, insn);
B
bellard 已提交
2807 2808 2809 2810 2811 2812
                }

                if (op == 15 && (rn == 16 || rn == 17)) {
                    /* Integer source.  */
                    rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
                } else {
P
pbrook 已提交
2813
                    VFP_DREG_M(rm, insn);
B
bellard 已提交
2814 2815
                }
            } else {
P
pbrook 已提交
2816
                rn = VFP_SREG_N(insn);
B
bellard 已提交
2817 2818
                if (op == 15 && rn == 15) {
                    /* Double precision destination.  */
P
pbrook 已提交
2819 2820 2821 2822 2823
                    VFP_DREG_D(rd, insn);
                } else {
                    rd = VFP_SREG_D(insn);
                }
                rm = VFP_SREG_M(insn);
B
bellard 已提交
2824 2825 2826 2827 2828 2829 2830 2831 2832 2833
            }

            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;
2834

B
bellard 已提交
2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880
            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 已提交
2881 2882 2883 2884
                case 20:
                case 21:
                case 22:
                case 23:
P
pbrook 已提交
2885 2886 2887 2888
                case 28:
                case 29:
                case 30:
                case 31:
P
pbrook 已提交
2889 2890 2891
                    /* Source and destination the same.  */
                    gen_mov_F0_vreg(dp, rd);
                    break;
B
bellard 已提交
2892 2893 2894
                default:
                    /* One source operand.  */
                    gen_mov_F0_vreg(dp, rm);
P
pbrook 已提交
2895
                    break;
B
bellard 已提交
2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924
                }
            } 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 已提交
2925 2926
                    gen_mov_F1_vreg(dp, rd);
                    gen_vfp_sub(dp);
B
bellard 已提交
2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943
                    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 已提交
2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955
                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 已提交
2956
                        tcg_gen_movi_i64(cpu_F0d, ((uint64_t)n) << 32);
P
pbrook 已提交
2957 2958 2959 2960 2961 2962
                    } else {
                        if (i & 0x40)
                            i |= 0x780;
                        else
                            i |= 0x800;
                        n |= i << 19;
B
balrog 已提交
2963
                        tcg_gen_movi_i32(cpu_F0s, n);
P
pbrook 已提交
2964 2965
                    }
                    break;
B
bellard 已提交
2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994
                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 已提交
2995
                            gen_helper_vfp_fcvtsd(cpu_F0s, cpu_F0d, cpu_env);
B
bellard 已提交
2996
                        else
P
pbrook 已提交
2997
                            gen_helper_vfp_fcvtds(cpu_F0d, cpu_F0s, cpu_env);
B
bellard 已提交
2998 2999 3000 3001 3002 3003 3004
                        break;
                    case 16: /* fuito */
                        gen_vfp_uito(dp);
                        break;
                    case 17: /* fsito */
                        gen_vfp_sito(dp);
                        break;
P
pbrook 已提交
3005 3006 3007
                    case 20: /* fshto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3008
                        gen_vfp_shto(dp, 16 - rm);
P
pbrook 已提交
3009 3010 3011 3012
                        break;
                    case 21: /* fslto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3013
                        gen_vfp_slto(dp, 32 - rm);
P
pbrook 已提交
3014 3015 3016 3017
                        break;
                    case 22: /* fuhto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3018
                        gen_vfp_uhto(dp, 16 - rm);
P
pbrook 已提交
3019 3020 3021 3022
                        break;
                    case 23: /* fulto */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3023
                        gen_vfp_ulto(dp, 32 - rm);
P
pbrook 已提交
3024
                        break;
B
bellard 已提交
3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036
                    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 已提交
3037 3038 3039
                    case 28: /* ftosh */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3040
                        gen_vfp_tosh(dp, 16 - rm);
P
pbrook 已提交
3041 3042 3043 3044
                        break;
                    case 29: /* ftosl */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3045
                        gen_vfp_tosl(dp, 32 - rm);
P
pbrook 已提交
3046 3047 3048 3049
                        break;
                    case 30: /* ftouh */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3050
                        gen_vfp_touh(dp, 16 - rm);
P
pbrook 已提交
3051 3052 3053 3054
                        break;
                    case 31: /* ftoul */
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
                          return 1;
P
pbrook 已提交
3055
                        gen_vfp_toul(dp, 32 - rm);
P
pbrook 已提交
3056
                        break;
B
bellard 已提交
3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 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
                    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 已提交
3118
        if (dp && (insn & 0x03e00000) == 0x00400000) {
B
bellard 已提交
3119 3120 3121 3122
            /* two-register transfer */
            rn = (insn >> 16) & 0xf;
            rd = (insn >> 12) & 0xf;
            if (dp) {
P
pbrook 已提交
3123 3124 3125 3126
                VFP_DREG_M(rm, insn);
            } else {
                rm = VFP_SREG_M(insn);
            }
B
bellard 已提交
3127

3128
            if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
3129 3130
                /* vfp->arm */
                if (dp) {
P
pbrook 已提交
3131 3132 3133 3134 3135 3136
                    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 已提交
3137 3138
                } else {
                    gen_mov_F0_vreg(0, rm);
P
pbrook 已提交
3139 3140
                    tmp = gen_vfp_mrs();
                    store_reg(s, rn, tmp);
B
bellard 已提交
3141
                    gen_mov_F0_vreg(0, rm + 1);
P
pbrook 已提交
3142 3143
                    tmp = gen_vfp_mrs();
                    store_reg(s, rd, tmp);
B
bellard 已提交
3144 3145 3146 3147
                }
            } else {
                /* arm->vfp */
                if (dp) {
P
pbrook 已提交
3148 3149 3150 3151 3152 3153
                    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 已提交
3154
                } else {
P
pbrook 已提交
3155 3156
                    tmp = load_reg(s, rn);
                    gen_vfp_msr(tmp);
B
bellard 已提交
3157
                    gen_mov_vreg_F0(0, rm);
P
pbrook 已提交
3158 3159
                    tmp = load_reg(s, rd);
                    gen_vfp_msr(tmp);
B
bellard 已提交
3160 3161 3162 3163 3164 3165 3166
                    gen_mov_vreg_F0(0, rm + 1);
                }
            }
        } else {
            /* Load/store */
            rn = (insn >> 16) & 0xf;
            if (dp)
P
pbrook 已提交
3167
                VFP_DREG_D(rd, insn);
B
bellard 已提交
3168
            else
P
pbrook 已提交
3169 3170
                rd = VFP_SREG_D(insn);
            if (s->thumb && rn == 15) {
3171 3172
                addr = new_tmp();
                tcg_gen_movi_i32(addr, s->pc & ~2);
P
pbrook 已提交
3173
            } else {
3174
                addr = load_reg(s, rn);
P
pbrook 已提交
3175
            }
B
bellard 已提交
3176 3177 3178 3179 3180
            if ((insn & 0x01200000) == 0x01000000) {
                /* Single load/store */
                offset = (insn & 0xff) << 2;
                if ((insn & (1 << 23)) == 0)
                    offset = -offset;
3181
                tcg_gen_addi_i32(addr, addr, offset);
B
bellard 已提交
3182
                if (insn & (1 << 20)) {
3183
                    gen_vfp_ld(s, dp, addr);
B
bellard 已提交
3184 3185 3186
                    gen_mov_vreg_F0(dp, rd);
                } else {
                    gen_mov_F0_vreg(dp, rd);
3187
                    gen_vfp_st(s, dp, addr);
B
bellard 已提交
3188
                }
3189
                dead_tmp(addr);
B
bellard 已提交
3190 3191 3192 3193 3194 3195 3196 3197
            } else {
                /* load/store multiple */
                if (dp)
                    n = (insn >> 1) & 0x7f;
                else
                    n = insn & 0xff;

                if (insn & (1 << 24)) /* pre-decrement */
3198
                    tcg_gen_addi_i32(addr, addr, -((insn & 0xff) << 2));
B
bellard 已提交
3199 3200 3201 3202 3203 3204

                if (dp)
                    offset = 8;
                else
                    offset = 4;
                for (i = 0; i < n; i++) {
3205
                    if (insn & ARM_CP_RW_BIT) {
B
bellard 已提交
3206
                        /* load */
3207
                        gen_vfp_ld(s, dp, addr);
B
bellard 已提交
3208 3209 3210 3211
                        gen_mov_vreg_F0(dp, rd + i);
                    } else {
                        /* store */
                        gen_mov_F0_vreg(dp, rd + i);
3212
                        gen_vfp_st(s, dp, addr);
B
bellard 已提交
3213
                    }
3214
                    tcg_gen_addi_i32(addr, addr, offset);
B
bellard 已提交
3215 3216 3217 3218 3219 3220 3221 3222 3223 3224 3225
                }
                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)
3226 3227 3228 3229
                        tcg_gen_addi_i32(addr, addr, offset);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
B
bellard 已提交
3230 3231 3232 3233 3234 3235 3236 3237 3238 3239 3240
                }
            }
        }
        break;
    default:
        /* Should never happen.  */
        return 1;
    }
    return 0;
}

3241
static inline void gen_goto_tb(DisasContext *s, int n, uint32_t dest)
B
bellard 已提交
3242
{
3243 3244 3245 3246
    TranslationBlock *tb;

    tb = s->tb;
    if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK)) {
B
bellard 已提交
3247
        tcg_gen_goto_tb(n);
P
pbrook 已提交
3248
        gen_set_pc_im(dest);
B
bellard 已提交
3249
        tcg_gen_exit_tb((long)tb + n);
3250
    } else {
P
pbrook 已提交
3251
        gen_set_pc_im(dest);
B
bellard 已提交
3252
        tcg_gen_exit_tb(0);
3253
    }
B
bellard 已提交
3254 3255
}

B
bellard 已提交
3256 3257
static inline void gen_jmp (DisasContext *s, uint32_t dest)
{
3258
    if (unlikely(s->singlestep_enabled)) {
B
bellard 已提交
3259
        /* An indirect jump so that we still trigger the debug exception.  */
B
bellard 已提交
3260
        if (s->thumb)
P
pbrook 已提交
3261 3262
            dest |= 1;
        gen_bx_im(s, dest);
B
bellard 已提交
3263
    } else {
3264
        gen_goto_tb(s, 0, dest);
B
bellard 已提交
3265 3266 3267 3268
        s->is_jmp = DISAS_TB_JUMP;
    }
}

P
pbrook 已提交
3269
static inline void gen_mulxy(TCGv t0, TCGv t1, int x, int y)
B
bellard 已提交
3270
{
B
bellard 已提交
3271
    if (x)
P
pbrook 已提交
3272
        tcg_gen_sari_i32(t0, t0, 16);
B
bellard 已提交
3273
    else
P
pbrook 已提交
3274
        gen_sxth(t0);
B
bellard 已提交
3275
    if (y)
P
pbrook 已提交
3276
        tcg_gen_sari_i32(t1, t1, 16);
B
bellard 已提交
3277
    else
P
pbrook 已提交
3278 3279
        gen_sxth(t1);
    tcg_gen_mul_i32(t0, t0, t1);
B
bellard 已提交
3280 3281 3282
}

/* Return the mask of PSR bits set by a MSR instruction.  */
P
pbrook 已提交
3283
static uint32_t msr_mask(CPUState *env, DisasContext *s, int flags, int spsr) {
B
bellard 已提交
3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294
    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 已提交
3295

P
pbrook 已提交
3296
    /* Mask out undefined bits.  */
P
pbrook 已提交
3297 3298
    mask &= ~CPSR_RESERVED;
    if (!arm_feature(env, ARM_FEATURE_V6))
P
pbrook 已提交
3299
        mask &= ~(CPSR_E | CPSR_GE);
P
pbrook 已提交
3300
    if (!arm_feature(env, ARM_FEATURE_THUMB2))
P
pbrook 已提交
3301
        mask &= ~CPSR_IT;
P
pbrook 已提交
3302
    /* Mask out execution state bits.  */
P
pbrook 已提交
3303
    if (!spsr)
P
pbrook 已提交
3304
        mask &= ~CPSR_EXEC;
B
bellard 已提交
3305 3306
    /* Mask out privileged bits.  */
    if (IS_USER(s))
P
pbrook 已提交
3307
        mask &= CPSR_USER;
B
bellard 已提交
3308 3309 3310
    return mask;
}

3311 3312
/* 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 已提交
3313
{
P
pbrook 已提交
3314
    TCGv tmp;
B
bellard 已提交
3315 3316 3317 3318
    if (spsr) {
        /* ??? This is also undefined in system mode.  */
        if (IS_USER(s))
            return 1;
P
pbrook 已提交
3319 3320 3321

        tmp = load_cpu_field(spsr);
        tcg_gen_andi_i32(tmp, tmp, ~mask);
3322 3323
        tcg_gen_andi_i32(t0, t0, mask);
        tcg_gen_or_i32(tmp, tmp, t0);
P
pbrook 已提交
3324
        store_cpu_field(tmp, spsr);
B
bellard 已提交
3325
    } else {
3326
        gen_set_cpsr(t0, mask);
B
bellard 已提交
3327
    }
3328
    dead_tmp(t0);
B
bellard 已提交
3329 3330 3331 3332
    gen_lookup_tb(s);
    return 0;
}

3333 3334 3335 3336 3337 3338 3339 3340 3341
/* 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);
}

3342 3343
/* Generate an old-style exception return. Marks pc as dead. */
static void gen_exception_return(DisasContext *s, TCGv pc)
B
bellard 已提交
3344
{
P
pbrook 已提交
3345
    TCGv tmp;
3346
    store_reg(s, 15, pc);
P
pbrook 已提交
3347 3348 3349
    tmp = load_cpu_field(spsr);
    gen_set_cpsr(tmp, 0xffffffff);
    dead_tmp(tmp);
B
bellard 已提交
3350 3351 3352
    s->is_jmp = DISAS_UPDATE;
}

P
pbrook 已提交
3353 3354
/* Generate a v6 exception return.  Marks both values as dead.  */
static void gen_rfe(DisasContext *s, TCGv pc, TCGv cpsr)
B
bellard 已提交
3355
{
P
pbrook 已提交
3356 3357 3358
    gen_set_cpsr(cpsr, 0xffffffff);
    dead_tmp(cpsr);
    store_reg(s, 15, pc);
P
pbrook 已提交
3359 3360
    s->is_jmp = DISAS_UPDATE;
}
3361

P
pbrook 已提交
3362 3363 3364 3365
static inline void
gen_set_condexec (DisasContext *s)
{
    if (s->condexec_mask) {
P
pbrook 已提交
3366 3367 3368
        uint32_t val = (s->condexec_cond << 4) | (s->condexec_mask >> 1);
        TCGv tmp = new_tmp();
        tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
3369
        store_cpu_field(tmp, condexec_bits);
P
pbrook 已提交
3370 3371
    }
}
3372

P
pbrook 已提交
3373 3374 3375 3376
static void gen_nop_hint(DisasContext *s, int val)
{
    switch (val) {
    case 3: /* wfi */
P
pbrook 已提交
3377
        gen_set_pc_im(s->pc);
P
pbrook 已提交
3378 3379 3380 3381 3382 3383 3384 3385 3386
        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 已提交
3387

P
pbrook 已提交
3388
#define CPU_V001 cpu_V0, cpu_V0, cpu_V1
P
pbrook 已提交
3389

3390
static inline int gen_neon_add(int size, TCGv t0, TCGv t1)
P
pbrook 已提交
3391 3392
{
    switch (size) {
3393 3394 3395
    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 已提交
3396 3397 3398 3399 3400
    default: return 1;
    }
    return 0;
}

3401
static inline void gen_neon_rsb(int size, TCGv t0, TCGv t1)
P
pbrook 已提交
3402 3403
{
    switch (size) {
3404 3405 3406
    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 已提交
3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425
    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: \
3426
        gen_helper_neon_##name##_s8(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3427 3428
        break; \
    case 1: \
3429
        gen_helper_neon_##name##_u8(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3430 3431
        break; \
    case 2: \
3432
        gen_helper_neon_##name##_s16(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3433 3434
        break; \
    case 3: \
3435
        gen_helper_neon_##name##_u16(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3436 3437
        break; \
    case 4: \
3438
        gen_helper_neon_##name##_s32(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3439 3440
        break; \
    case 5: \
3441
        gen_helper_neon_##name##_u32(tmp, cpu_env, tmp, tmp2); \
P
pbrook 已提交
3442 3443 3444
        break; \
    default: return 1; \
    }} while (0)
P
pbrook 已提交
3445 3446 3447

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

3469
static TCGv neon_load_scratch(int scratch)
P
pbrook 已提交
3470
{
3471 3472 3473
    TCGv tmp = new_tmp();
    tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
    return tmp;
P
pbrook 已提交
3474 3475
}

3476
static void neon_store_scratch(int scratch, TCGv var)
P
pbrook 已提交
3477
{
3478 3479
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
    dead_tmp(var);
P
pbrook 已提交
3480 3481
}

3482
static inline TCGv neon_get_scalar(int size, int reg)
P
pbrook 已提交
3483
{
3484
    TCGv tmp;
P
pbrook 已提交
3485
    if (size == 1) {
3486
        tmp = neon_load_reg(reg >> 1, reg & 1);
P
pbrook 已提交
3487
    } else {
3488 3489 3490 3491 3492 3493
        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 已提交
3494
    }
3495
    return tmp;
P
pbrook 已提交
3496 3497
}

3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 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
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 已提交
3589 3590 3591
static void gen_neon_unzip(int reg, int q, int tmp, int size)
{
    int n;
3592
    TCGv t0, t1;
P
pbrook 已提交
3593 3594

    for (n = 0; n < q + 1; n += 2) {
3595 3596
        t0 = neon_load_reg(reg, n);
        t1 = neon_load_reg(reg, n + 1);
P
pbrook 已提交
3597
        switch (size) {
3598 3599
        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 已提交
3600 3601 3602
        case 2: /* no-op */; break;
        default: abort();
        }
3603 3604
        neon_store_scratch(tmp + n, t0);
        neon_store_scratch(tmp + n + 1, t1);
P
pbrook 已提交
3605 3606 3607
    }
}

3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649
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 已提交
3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681 3682
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;
3683
    TCGv addr;
P
pbrook 已提交
3684
    TCGv tmp;
P
pbrook 已提交
3685
    TCGv tmp2;
P
pbrook 已提交
3686 3687 3688 3689 3690 3691 3692

    if (!vfp_enabled(env))
      return 1;
    VFP_DREG_D(rd, insn);
    rn = (insn >> 16) & 0xf;
    rm = insn & 0xf;
    load = (insn & (1 << 21)) != 0;
3693
    addr = new_tmp();
P
pbrook 已提交
3694 3695 3696 3697 3698 3699 3700 3701
    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;
3702
        tcg_gen_mov_i32(addr, cpu_R[rn]);
P
pbrook 已提交
3703 3704 3705
        stride = (1 << size) * interleave;
        for (reg = 0; reg < nregs; reg++) {
            if (interleave > 2 || (interleave == 2 && nregs == 2)) {
3706
                tcg_gen_addi_i32(addr, cpu_R[rn], (1 << size) * reg);
P
pbrook 已提交
3707
            } else if (interleave == 2 && nregs == 4 && reg == 2) {
3708
                tcg_gen_addi_i32(addr, cpu_R[rn], 1 << size);
P
pbrook 已提交
3709 3710 3711 3712
            }
            for (pass = 0; pass < 2; pass++) {
                if (size == 2) {
                    if (load) {
3713
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3714
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3715
                    } else {
P
pbrook 已提交
3716
                        tmp = neon_load_reg(rd, pass);
3717
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
3718
                    }
3719
                    tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3720 3721
                } else if (size == 1) {
                    if (load) {
3722 3723 3724 3725
                        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 已提交
3726 3727 3728
                        gen_bfi(tmp, tmp, tmp2, 16, 0xffff);
                        dead_tmp(tmp2);
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3729
                    } else {
P
pbrook 已提交
3730 3731 3732
                        tmp = neon_load_reg(rd, pass);
                        tmp2 = new_tmp();
                        tcg_gen_shri_i32(tmp2, tmp, 16);
3733 3734 3735 3736
                        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 已提交
3737 3738 3739
                    }
                } else /* size == 0 */ {
                    if (load) {
P
pbrook 已提交
3740
                        TCGV_UNUSED(tmp2);
P
pbrook 已提交
3741
                        for (n = 0; n < 4; n++) {
3742 3743
                            tmp = gen_ld8u(addr, IS_USER(s));
                            tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3744
                            if (n == 0) {
P
pbrook 已提交
3745
                                tmp2 = tmp;
P
pbrook 已提交
3746
                            } else {
P
pbrook 已提交
3747 3748
                                gen_bfi(tmp2, tmp2, tmp, n * 8, 0xff);
                                dead_tmp(tmp);
P
pbrook 已提交
3749 3750
                            }
                        }
P
pbrook 已提交
3751
                        neon_store_reg(rd, pass, tmp2);
P
pbrook 已提交
3752
                    } else {
P
pbrook 已提交
3753
                        tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
3754
                        for (n = 0; n < 4; n++) {
P
pbrook 已提交
3755
                            tmp = new_tmp();
P
pbrook 已提交
3756
                            if (n == 0) {
P
pbrook 已提交
3757
                                tcg_gen_mov_i32(tmp, tmp2);
P
pbrook 已提交
3758
                            } else {
P
pbrook 已提交
3759
                                tcg_gen_shri_i32(tmp, tmp2, n * 8);
P
pbrook 已提交
3760
                            }
3761 3762
                            gen_st8(tmp, addr, IS_USER(s));
                            tcg_gen_addi_i32(addr, addr, stride);
P
pbrook 已提交
3763
                        }
P
pbrook 已提交
3764
                        dead_tmp(tmp2);
P
pbrook 已提交
3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779
                    }
                }
            }
            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;
3780
            tcg_gen_mov_i32(addr, cpu_R[rn]);
P
pbrook 已提交
3781 3782 3783
            for (reg = 0; reg < nregs; reg++) {
                switch (size) {
                case 0:
3784
                    tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
3785
                    gen_neon_dup_u8(tmp, 0);
P
pbrook 已提交
3786 3787
                    break;
                case 1:
3788
                    tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
3789
                    gen_neon_dup_low16(tmp);
P
pbrook 已提交
3790 3791
                    break;
                case 2:
3792
                    tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3793 3794 3795
                    break;
                case 3:
                    return 1;
P
pbrook 已提交
3796 3797
                default: /* Avoid compiler warnings.  */
                    abort();
B
bellard 已提交
3798
                }
3799
                tcg_gen_addi_i32(addr, addr, 1 << size);
P
pbrook 已提交
3800 3801 3802
                tmp2 = new_tmp();
                tcg_gen_mov_i32(tmp2, tmp);
                neon_store_reg(rd, 0, tmp2);
P
pbrook 已提交
3803
                neon_store_reg(rd, 1, tmp);
P
pbrook 已提交
3804 3805 3806 3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826
                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;
3827
            tcg_gen_mov_i32(addr, cpu_R[rn]);
P
pbrook 已提交
3828 3829 3830 3831
            for (reg = 0; reg < nregs; reg++) {
                if (load) {
                    switch (size) {
                    case 0:
3832
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
3833 3834
                        break;
                    case 1:
3835
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
3836 3837
                        break;
                    case 2:
3838
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
3839
                        break;
P
pbrook 已提交
3840 3841
                    default: /* Avoid compiler warnings.  */
                        abort();
P
pbrook 已提交
3842 3843
                    }
                    if (size != 2) {
P
pbrook 已提交
3844 3845 3846
                        tmp2 = neon_load_reg(rd, pass);
                        gen_bfi(tmp, tmp2, tmp, shift, size ? 0xffff : 0xff);
                        dead_tmp(tmp2);
P
pbrook 已提交
3847
                    }
P
pbrook 已提交
3848
                    neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
3849
                } else { /* Store */
P
pbrook 已提交
3850 3851 3852
                    tmp = neon_load_reg(rd, pass);
                    if (shift)
                        tcg_gen_shri_i32(tmp, tmp, shift);
P
pbrook 已提交
3853 3854
                    switch (size) {
                    case 0:
3855
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
3856 3857
                        break;
                    case 1:
3858
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
3859 3860
                        break;
                    case 2:
3861
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
3862
                        break;
B
bellard 已提交
3863 3864
                    }
                }
P
pbrook 已提交
3865
                rd += stride;
3866
                tcg_gen_addi_i32(addr, addr, 1 << size);
B
bellard 已提交
3867
            }
P
pbrook 已提交
3868
            stride = nregs * (1 << size);
B
bellard 已提交
3869
        }
P
pbrook 已提交
3870
    }
3871
    dead_tmp(addr);
P
pbrook 已提交
3872
    if (rm != 15) {
P
pbrook 已提交
3873 3874 3875
        TCGv base;

        base = load_reg(s, rn);
P
pbrook 已提交
3876
        if (rm == 13) {
P
pbrook 已提交
3877
            tcg_gen_addi_i32(base, base, stride);
P
pbrook 已提交
3878
        } else {
P
pbrook 已提交
3879 3880 3881 3882
            TCGv index;
            index = load_reg(s, rm);
            tcg_gen_add_i32(base, base, index);
            dead_tmp(index);
P
pbrook 已提交
3883
        }
P
pbrook 已提交
3884
        store_reg(s, rn, base);
P
pbrook 已提交
3885 3886 3887
    }
    return 0;
}
3888

P
pbrook 已提交
3889 3890 3891 3892 3893 3894 3895 3896
/* 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 已提交
3897
static inline void gen_neon_narrow(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3898 3899 3900 3901 3902 3903 3904 3905 3906
{
    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 已提交
3907
static inline void gen_neon_narrow_sats(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3908 3909 3910 3911 3912 3913 3914 3915 3916
{
    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 已提交
3917
static inline void gen_neon_narrow_satu(int size, TCGv dest, TCGv_i64 src)
P
pbrook 已提交
3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939 3940 3941 3942 3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960
{
    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 已提交
3961
static inline void gen_neon_widen(TCGv_i64 dest, TCGv src, int size, int u)
P
pbrook 已提交
3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000
{
    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 已提交
4001
static inline void gen_neon_negl(TCGv_i64 var, int size)
P
pbrook 已提交
4002 4003 4004 4005 4006 4007 4008 4009 4010
{
    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 已提交
4011
static inline void gen_neon_addl_saturate(TCGv_i64 op0, TCGv_i64 op1, int size)
P
pbrook 已提交
4012 4013 4014 4015 4016 4017 4018 4019
{
    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 已提交
4020
static inline void gen_neon_mull(TCGv_i64 dest, TCGv a, TCGv b, int size, int u)
P
pbrook 已提交
4021
{
P
pbrook 已提交
4022
    TCGv_i64 tmp;
P
pbrook 已提交
4023 4024 4025 4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038 4039 4040

    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 已提交
4041 4042
/* Translate a NEON data processing instruction.  Return nonzero if the
   instruction is invalid.
P
pbrook 已提交
4043 4044
   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 已提交
4045

P
pbrook 已提交
4046 4047 4048 4049 4050 4051 4052 4053 4054 4055 4056 4057 4058
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;
P
pbrook 已提交
4059 4060 4061
    TCGv tmp;
    TCGv tmp2;
    TCGv tmp3;
P
pbrook 已提交
4062
    TCGv_i64 tmp64;
P
pbrook 已提交
4063 4064 4065 4066 4067 4068 4069 4070 4071 4072 4073 4074

    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 已提交
4075 4076 4077
        if (size == 3 && (op == 1 || op == 5 || op == 8 || op == 9
                          || op == 10 || op  == 11 || op == 16)) {
            /* 64-bit element instructions.  */
P
pbrook 已提交
4078
            for (pass = 0; pass < (q ? 2 : 1); pass++) {
P
pbrook 已提交
4079 4080
                neon_load_reg64(cpu_V0, rn + pass);
                neon_load_reg64(cpu_V1, rm + pass);
P
pbrook 已提交
4081 4082 4083
                switch (op) {
                case 1: /* VQADD */
                    if (u) {
P
pbrook 已提交
4084
                        gen_helper_neon_add_saturate_u64(CPU_V001);
B
bellard 已提交
4085
                    } else {
P
pbrook 已提交
4086
                        gen_helper_neon_add_saturate_s64(CPU_V001);
B
bellard 已提交
4087
                    }
P
pbrook 已提交
4088 4089 4090
                    break;
                case 5: /* VQSUB */
                    if (u) {
P
pbrook 已提交
4091 4092 4093 4094 4095 4096 4097 4098 4099 4100 4101 4102 4103 4104 4105 4106 4107 4108 4109 4110 4111 4112 4113 4114
                        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 已提交
4115
                    } else {
P
pbrook 已提交
4116 4117 4118 4119 4120 4121 4122 4123 4124 4125
                        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 已提交
4126
                    }
P
pbrook 已提交
4127 4128 4129
                    break;
                case 16:
                    if (u) {
P
pbrook 已提交
4130
                        tcg_gen_sub_i64(CPU_V001);
P
pbrook 已提交
4131
                    } else {
P
pbrook 已提交
4132
                        tcg_gen_add_i64(CPU_V001);
P
pbrook 已提交
4133 4134 4135 4136
                    }
                    break;
                default:
                    abort();
B
bellard 已提交
4137
                }
P
pbrook 已提交
4138
                neon_store_reg64(cpu_V0, rd + pass);
B
bellard 已提交
4139
            }
P
pbrook 已提交
4140
            return 0;
B
bellard 已提交
4141
        }
P
pbrook 已提交
4142 4143 4144 4145
        switch (op) {
        case 8: /* VSHL */
        case 9: /* VQSHL */
        case 10: /* VRSHL */
P
pbrook 已提交
4146
        case 11: /* VQRSHL */
P
pbrook 已提交
4147
            {
P
pbrook 已提交
4148 4149 4150
                int rtmp;
                /* Shift instruction operands are reversed.  */
                rtmp = rn;
P
pbrook 已提交
4151
                rn = rm;
P
pbrook 已提交
4152
                rm = rtmp;
P
pbrook 已提交
4153 4154
                pairwise = 0;
            }
B
bellard 已提交
4155
            break;
P
pbrook 已提交
4156 4157 4158 4159
        case 20: /* VPMAX */
        case 21: /* VPMIN */
        case 23: /* VPADD */
            pairwise = 1;
B
bellard 已提交
4160
            break;
P
pbrook 已提交
4161 4162
        case 26: /* VPADD (float) */
            pairwise = (u && size < 2);
B
bellard 已提交
4163
            break;
P
pbrook 已提交
4164 4165
        case 30: /* VPMIN/VPMAX (float) */
            pairwise = u;
B
bellard 已提交
4166
            break;
P
pbrook 已提交
4167 4168
        default:
            pairwise = 0;
B
bellard 已提交
4169
            break;
P
pbrook 已提交
4170
        }
4171

P
pbrook 已提交
4172 4173 4174 4175 4176 4177
        for (pass = 0; pass < (q ? 4 : 2); pass++) {

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

P
pbrook 已提交
4429 4430 4431 4432
        /* 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) {
4433
            neon_store_scratch(pass, tmp);
P
pbrook 已提交
4434
        } else {
4435
            neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4436 4437 4438 4439 4440
        }

        } /* for pass */
        if (pairwise && rd == rm) {
            for (pass = 0; pass < (q ? 4 : 2); pass++) {
4441 4442
                tmp = neon_load_scratch(pass);
                neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4443 4444
            }
        }
P
pbrook 已提交
4445
        /* End of 3 register same size operations.  */
P
pbrook 已提交
4446 4447 4448 4449 4450 4451 4452 4453 4454 4455 4456 4457 4458 4459 4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473 4474 4475 4476 4477 4478 4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489 4490 4491
    } 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 已提交
4492 4493 4494 4495 4496 4497 4498 4499
                    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 已提交
4500
                            else
P
pbrook 已提交
4501
                                gen_helper_neon_shl_s64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4502
                            break;
P
pbrook 已提交
4503 4504 4505 4506
                        case 2: /* VRSHR */
                        case 3: /* VRSRA */
                            if (u)
                                gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4507
                            else
P
pbrook 已提交
4508
                                gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, cpu_V1);
P
pbrook 已提交
4509
                            break;
P
pbrook 已提交
4510 4511 4512 4513 4514 4515 4516 4517 4518 4519 4520
                        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 已提交
4521
                            else
P
pbrook 已提交
4522 4523 4524 4525
                                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 已提交
4526 4527
                            break;
                        }
P
pbrook 已提交
4528 4529 4530 4531 4532 4533 4534 4535 4536 4537 4538
                        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.  */
4539 4540 4541
                        tmp = neon_load_reg(rm, pass);
                        tmp2 = new_tmp();
                        tcg_gen_movi_i32(tmp2, imm);
P
pbrook 已提交
4542 4543 4544 4545 4546 4547 4548 4549 4550 4551 4552 4553 4554 4555 4556 4557
                        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) {
4558 4559 4560
                            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 已提交
4561 4562 4563 4564 4565 4566 4567 4568
                            default: return 1;
                            }
                            break;
                        case 6: /* VQSHL */
                            GEN_NEON_INTEGER_OP_ENV(qshl);
                            break;
                        case 7: /* VQSHLU */
                            switch (size) {
4569 4570 4571
                            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 已提交
4572 4573 4574 4575
                            default: return 1;
                            }
                            break;
                        }
4576
                        dead_tmp(tmp2);
P
pbrook 已提交
4577 4578 4579

                        if (op == 1 || op == 3) {
                            /* Accumulate.  */
4580 4581 4582
                            tmp2 = neon_load_reg(rd, pass);
                            gen_neon_add(size, tmp2, tmp);
                            dead_tmp(tmp2);
P
pbrook 已提交
4583 4584 4585 4586 4587 4588 4589 4590 4591 4592 4593 4594 4595 4596 4597 4598 4599 4600 4601 4602 4603 4604 4605 4606 4607 4608 4609
                        } 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();
                            }
4610 4611 4612 4613 4614
                            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 已提交
4615
                        }
4616
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4617 4618 4619
                    }
                } /* for pass */
            } else if (op < 10) {
P
pbrook 已提交
4620
                /* Shift by immediate and narrow:
P
pbrook 已提交
4621 4622 4623 4624 4625
                   VSHRN, VRSHRN, VQSHRN, VQRSHRN.  */
                shift = shift - (1 << (size + 3));
                size++;
                switch (size) {
                case 1:
P
pbrook 已提交
4626
                    imm = (uint16_t)shift;
P
pbrook 已提交
4627
                    imm |= imm << 16;
P
pbrook 已提交
4628
                    tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
4629
                    TCGV_UNUSED_I64(tmp64);
P
pbrook 已提交
4630 4631
                    break;
                case 2:
P
pbrook 已提交
4632 4633
                    imm = (uint32_t)shift;
                    tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
4634
                    TCGV_UNUSED_I64(tmp64);
4635
                    break;
P
pbrook 已提交
4636
                case 3:
P
pbrook 已提交
4637 4638
                    tmp64 = tcg_const_i64(shift);
                    TCGV_UNUSED(tmp2);
P
pbrook 已提交
4639 4640 4641 4642 4643
                    break;
                default:
                    abort();
                }

P
pbrook 已提交
4644 4645 4646 4647 4648
                for (pass = 0; pass < 2; pass++) {
                    if (size == 3) {
                        neon_load_reg64(cpu_V0, rm + pass);
                        if (q) {
                          if (u)
P
pbrook 已提交
4649
                            gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4650
                          else
P
pbrook 已提交
4651
                            gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4652 4653
                        } else {
                          if (u)
P
pbrook 已提交
4654
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4655
                          else
P
pbrook 已提交
4656
                            gen_helper_neon_shl_s64(cpu_V0, cpu_V0, tmp64);
P
pbrook 已提交
4657
                        }
B
bellard 已提交
4658
                    } else {
P
pbrook 已提交
4659 4660
                        tmp = neon_load_reg(rm + pass, 0);
                        gen_neon_shift_narrow(size, tmp, tmp2, q, u);
P
pbrook 已提交
4661 4662 4663
                        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 已提交
4664
                        dead_tmp(tmp);
P
pbrook 已提交
4665
                        dead_tmp(tmp3);
P
pbrook 已提交
4666
                    }
P
pbrook 已提交
4667 4668 4669
                    tmp = new_tmp();
                    if (op == 8 && !u) {
                        gen_neon_narrow(size - 1, tmp, cpu_V0);
P
pbrook 已提交
4670
                    } else {
P
pbrook 已提交
4671 4672
                        if (op == 8)
                            gen_neon_narrow_sats(size - 1, tmp, cpu_V0);
P
pbrook 已提交
4673
                        else
P
pbrook 已提交
4674 4675 4676 4677 4678 4679 4680
                            gen_neon_narrow_satu(size - 1, tmp, cpu_V0);
                    }
                    if (pass == 0) {
                        tmp2 = tmp;
                    } else {
                        neon_store_reg(rd, 0, tmp2);
                        neon_store_reg(rd, 1, tmp);
P
pbrook 已提交
4681 4682 4683 4684
                    }
                } /* for pass */
            } else if (op == 10) {
                /* VSHLL */
P
pbrook 已提交
4685
                if (q || size == 3)
P
pbrook 已提交
4686
                    return 1;
P
pbrook 已提交
4687 4688
                tmp = neon_load_reg(rm, 0);
                tmp2 = neon_load_reg(rm, 1);
P
pbrook 已提交
4689
                for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
4690 4691 4692 4693
                    if (pass == 1)
                        tmp = tmp2;

                    gen_neon_widen(cpu_V0, tmp, size, u);
P
pbrook 已提交
4694 4695 4696

                    if (shift != 0) {
                        /* The shift is less than the width of the source
P
pbrook 已提交
4697 4698 4699 4700 4701 4702 4703 4704 4705
                           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 已提交
4706
                            }
P
pbrook 已提交
4707 4708
                            imm64 = imm | (((uint64_t)imm) << 32);
                            tcg_gen_andi_i64(cpu_V0, cpu_V0, imm64);
P
pbrook 已提交
4709 4710
                        }
                    }
P
pbrook 已提交
4711
                    neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
4712 4713 4714 4715
                }
            } else if (op == 15 || op == 16) {
                /* VCVT fixed-point.  */
                for (pass = 0; pass < (q ? 4 : 2); pass++) {
P
pbrook 已提交
4716
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, pass));
P
pbrook 已提交
4717 4718
                    if (op & 1) {
                        if (u)
P
pbrook 已提交
4719
                            gen_vfp_ulto(0, shift);
P
pbrook 已提交
4720
                        else
P
pbrook 已提交
4721
                            gen_vfp_slto(0, shift);
P
pbrook 已提交
4722 4723
                    } else {
                        if (u)
P
pbrook 已提交
4724
                            gen_vfp_toul(0, shift);
P
pbrook 已提交
4725
                        else
P
pbrook 已提交
4726
                            gen_vfp_tosl(0, shift);
B
bellard 已提交
4727
                    }
P
pbrook 已提交
4728
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, pass));
B
bellard 已提交
4729 4730
                }
            } else {
P
pbrook 已提交
4731 4732 4733 4734 4735 4736 4737 4738 4739 4740 4741 4742 4743 4744 4745 4746 4747 4748 4749 4750 4751 4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772 4773 4774 4775 4776 4777 4778 4779
                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 已提交
4780
                    tmp = neon_load_reg(rd, pass);
P
pbrook 已提交
4781 4782 4783
                    if (invert) {
                        /* The immediate value has already been inverted, so
                           BIC becomes AND.  */
P
pbrook 已提交
4784
                        tcg_gen_andi_i32(tmp, tmp, imm);
P
pbrook 已提交
4785
                    } else {
P
pbrook 已提交
4786
                        tcg_gen_ori_i32(tmp, tmp, imm);
P
pbrook 已提交
4787 4788
                    }
                } else {
P
pbrook 已提交
4789 4790
                    /* VMOV, VMVN.  */
                    tmp = new_tmp();
P
pbrook 已提交
4791
                    if (op == 14 && invert) {
P
pbrook 已提交
4792 4793
                        uint32_t val;
                        val = 0;
P
pbrook 已提交
4794 4795
                        for (n = 0; n < 4; n++) {
                            if (imm & (1 << (n + (pass & 1) * 4)))
P
pbrook 已提交
4796
                                val |= 0xff << (n * 8);
P
pbrook 已提交
4797
                        }
P
pbrook 已提交
4798 4799 4800
                        tcg_gen_movi_i32(tmp, val);
                    } else {
                        tcg_gen_movi_i32(tmp, imm);
P
pbrook 已提交
4801 4802
                    }
                }
P
pbrook 已提交
4803
                neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
4804 4805
            }
        }
P
pbrook 已提交
4806
    } else { /* (insn & 0x00800010 == 0x00800000) */
P
pbrook 已提交
4807 4808 4809 4810 4811 4812 4813 4814 4815 4816 4817 4818 4819 4820 4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834 4835 4836
        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 已提交
4837 4838 4839
                if (size == 0 && (op == 9 || op == 11 || op == 13))
                    return 1;

P
pbrook 已提交
4840 4841 4842
                /* Avoid overlapping operands.  Wide source operands are
                   always aligned so will never overlap with wide
                   destinations in problematic ways.  */
P
pbrook 已提交
4843
                if (rd == rm && !src2_wide) {
4844 4845
                    tmp = neon_load_reg(rm, 1);
                    neon_store_scratch(2, tmp);
P
pbrook 已提交
4846
                } else if (rd == rn && !src1_wide) {
4847 4848
                    tmp = neon_load_reg(rn, 1);
                    neon_store_scratch(2, tmp);
P
pbrook 已提交
4849
                }
P
pbrook 已提交
4850
                TCGV_UNUSED(tmp3);
P
pbrook 已提交
4851
                for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
4852 4853
                    if (src1_wide) {
                        neon_load_reg64(cpu_V0, rn + pass);
P
pbrook 已提交
4854
                        TCGV_UNUSED(tmp);
P
pbrook 已提交
4855
                    } else {
P
pbrook 已提交
4856
                        if (pass == 1 && rd == rn) {
4857
                            tmp = neon_load_scratch(2);
P
pbrook 已提交
4858
                        } else {
P
pbrook 已提交
4859 4860 4861 4862
                            tmp = neon_load_reg(rn, pass);
                        }
                        if (prewiden) {
                            gen_neon_widen(cpu_V0, tmp, size, u);
P
pbrook 已提交
4863 4864
                        }
                    }
P
pbrook 已提交
4865 4866
                    if (src2_wide) {
                        neon_load_reg64(cpu_V1, rm + pass);
P
pbrook 已提交
4867
                        TCGV_UNUSED(tmp2);
P
pbrook 已提交
4868
                    } else {
P
pbrook 已提交
4869
                        if (pass == 1 && rd == rm) {
4870
                            tmp2 = neon_load_scratch(2);
P
pbrook 已提交
4871
                        } else {
P
pbrook 已提交
4872 4873 4874 4875
                            tmp2 = neon_load_reg(rm, pass);
                        }
                        if (prewiden) {
                            gen_neon_widen(cpu_V1, tmp2, size, u);
P
pbrook 已提交
4876 4877 4878 4879
                        }
                    }
                    switch (op) {
                    case 0: case 1: case 4: /* VADDL, VADDW, VADDHN, VRADDHN */
P
pbrook 已提交
4880
                        gen_neon_addl(size);
P
pbrook 已提交
4881 4882
                        break;
                    case 2: case 3: case 6: /* VSUBL, VSUBW, VSUBHL, VRSUBHL */
P
pbrook 已提交
4883
                        gen_neon_subl(size);
P
pbrook 已提交
4884 4885 4886
                        break;
                    case 5: case 7: /* VABAL, VABDL */
                        switch ((size << 1) | u) {
P
pbrook 已提交
4887 4888 4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903 4904
                        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 已提交
4905 4906
                        default: abort();
                        }
P
pbrook 已提交
4907 4908
                        dead_tmp(tmp2);
                        dead_tmp(tmp);
P
pbrook 已提交
4909 4910 4911
                        break;
                    case 8: case 9: case 10: case 11: case 12: case 13:
                        /* VMLAL, VQDMLAL, VMLSL, VQDMLSL, VMULL, VQDMULL */
P
pbrook 已提交
4912
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
4913 4914
                        dead_tmp(tmp2);
                        dead_tmp(tmp);
P
pbrook 已提交
4915 4916 4917 4918 4919 4920 4921 4922 4923 4924
                        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 已提交
4925
                            gen_neon_negl(cpu_V0, size);
P
pbrook 已提交
4926 4927 4928
                        }

                        if (op != 13) {
P
pbrook 已提交
4929
                            neon_load_reg64(cpu_V1, rd + pass);
P
pbrook 已提交
4930 4931 4932 4933
                        }

                        switch (op) {
                        case 5: case 8: case 10: /* VABAL, VMLAL, VMLSL */
P
pbrook 已提交
4934
                            gen_neon_addl(size);
P
pbrook 已提交
4935 4936
                            break;
                        case 9: case 11: /* VQDMLAL, VQDMLSL */
P
pbrook 已提交
4937 4938 4939
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
                            break;
P
pbrook 已提交
4940 4941
                            /* Fall through.  */
                        case 13: /* VQDMULL */
P
pbrook 已提交
4942
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
P
pbrook 已提交
4943 4944 4945 4946
                            break;
                        default:
                            abort();
                        }
P
pbrook 已提交
4947
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
4948 4949
                    } else if (op == 4 || op == 6) {
                        /* Narrowing operation.  */
P
pbrook 已提交
4950
                        tmp = new_tmp();
P
pbrook 已提交
4951 4952
                        if (u) {
                            switch (size) {
P
pbrook 已提交
4953 4954 4955 4956 4957 4958 4959 4960 4961 4962
                            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 已提交
4963 4964 4965 4966
                            default: abort();
                            }
                        } else {
                            switch (size) {
P
pbrook 已提交
4967 4968 4969 4970 4971 4972 4973 4974 4975 4976 4977
                            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 已提交
4978 4979 4980
                            default: abort();
                            }
                        }
P
pbrook 已提交
4981 4982 4983 4984 4985 4986
                        if (pass == 0) {
                            tmp3 = tmp;
                        } else {
                            neon_store_reg(rd, 0, tmp3);
                            neon_store_reg(rd, 1, tmp);
                        }
P
pbrook 已提交
4987 4988
                    } else {
                        /* Write back the result.  */
P
pbrook 已提交
4989
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000 5001 5002
                    }
                }
            } 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 */
5003 5004
                    tmp = neon_get_scalar(size, rm);
                    neon_store_scratch(0, tmp);
P
pbrook 已提交
5005
                    for (pass = 0; pass < (u ? 4 : 2); pass++) {
5006 5007
                        tmp = neon_load_scratch(0);
                        tmp2 = neon_load_reg(rn, pass);
P
pbrook 已提交
5008 5009
                        if (op == 12) {
                            if (size == 1) {
5010
                                gen_helper_neon_qdmulh_s16(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5011
                            } else {
5012
                                gen_helper_neon_qdmulh_s32(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5013 5014 5015
                            }
                        } else if (op == 13) {
                            if (size == 1) {
5016
                                gen_helper_neon_qrdmulh_s16(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5017
                            } else {
5018
                                gen_helper_neon_qrdmulh_s32(tmp, cpu_env, tmp, tmp2);
P
pbrook 已提交
5019 5020
                            }
                        } else if (op & 1) {
5021
                            gen_helper_neon_mul_f32(tmp, tmp, tmp2);
P
pbrook 已提交
5022 5023
                        } else {
                            switch (size) {
5024 5025 5026
                            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 已提交
5027 5028 5029
                            default: return 1;
                            }
                        }
5030
                        dead_tmp(tmp2);
P
pbrook 已提交
5031 5032
                        if (op < 8) {
                            /* Accumulate.  */
5033
                            tmp2 = neon_load_reg(rd, pass);
P
pbrook 已提交
5034 5035
                            switch (op) {
                            case 0:
5036
                                gen_neon_add(size, tmp, tmp2);
P
pbrook 已提交
5037 5038
                                break;
                            case 1:
5039
                                gen_helper_neon_add_f32(tmp, tmp, tmp2);
P
pbrook 已提交
5040 5041
                                break;
                            case 4:
5042
                                gen_neon_rsb(size, tmp, tmp2);
P
pbrook 已提交
5043 5044
                                break;
                            case 5:
5045
                                gen_helper_neon_sub_f32(tmp, tmp2, tmp);
P
pbrook 已提交
5046 5047 5048 5049
                                break;
                            default:
                                abort();
                            }
5050
                            dead_tmp(tmp2);
P
pbrook 已提交
5051
                        }
5052
                        neon_store_reg(rd, pass, tmp);
P
pbrook 已提交
5053 5054 5055 5056 5057 5058 5059 5060
                    }
                    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 已提交
5061 5062 5063
                    if (size == 0 && (op == 3 || op == 7 || op == 11))
                        return 1;

5064 5065
                    tmp2 = neon_get_scalar(size, rm);
                    tmp3 = neon_load_reg(rn, 1);
P
pbrook 已提交
5066

P
pbrook 已提交
5067
                    for (pass = 0; pass < 2; pass++) {
P
pbrook 已提交
5068 5069
                        if (pass == 0) {
                            tmp = neon_load_reg(rn, 0);
P
pbrook 已提交
5070
                        } else {
5071
                            tmp = tmp3;
P
pbrook 已提交
5072
                        }
P
pbrook 已提交
5073
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
5074
                        dead_tmp(tmp);
P
pbrook 已提交
5075
                        if (op == 6 || op == 7) {
P
pbrook 已提交
5076 5077 5078 5079
                            gen_neon_negl(cpu_V0, size);
                        }
                        if (op != 11) {
                            neon_load_reg64(cpu_V1, rd + pass);
P
pbrook 已提交
5080 5081 5082
                        }
                        switch (op) {
                        case 2: case 6:
P
pbrook 已提交
5083
                            gen_neon_addl(size);
P
pbrook 已提交
5084 5085
                            break;
                        case 3: case 7:
P
pbrook 已提交
5086 5087
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
P
pbrook 已提交
5088 5089 5090 5091 5092
                            break;
                        case 10:
                            /* no-op */
                            break;
                        case 11:
P
pbrook 已提交
5093
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
P
pbrook 已提交
5094 5095 5096 5097
                            break;
                        default:
                            abort();
                        }
P
pbrook 已提交
5098
                        neon_store_reg64(cpu_V0, rd + pass);
P
pbrook 已提交
5099
                    }
5100 5101 5102

                    dead_tmp(tmp2);

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

5556 5557 5558 5559 5560 5561 5562 5563 5564 5565 5566 5567 5568 5569 5570 5571 5572 5573 5574 5575 5576 5577 5578 5579 5580 5581 5582 5583 5584 5585 5586 5587 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
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 已提交
5621 5622 5623 5624 5625 5626 5627 5628 5629 5630 5631 5632 5633 5634 5635 5636 5637 5638 5639 5640 5641
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);
5642 5643 5644 5645 5646 5647 5648 5649 5650
    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 已提交
5651 5652 5653
    case 15:
	return disas_cp15_insn (env, s, insn);
    default:
5654
    board:
P
pbrook 已提交
5655 5656 5657 5658 5659
	/* Unknown coprocessor.  See if the board has hooked it.  */
	return disas_cp_insn (env, s, insn);
    }
}

P
pbrook 已提交
5660 5661

/* Store a 64-bit value to a register pair.  Clobbers val.  */
P
pbrook 已提交
5662
static void gen_storeq_reg(DisasContext *s, int rlow, int rhigh, TCGv_i64 val)
P
pbrook 已提交
5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674
{
    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 已提交
5675
static void gen_addq_lo(DisasContext *s, TCGv_i64 val, int rlow)
P
pbrook 已提交
5676
{
P
pbrook 已提交
5677
    TCGv_i64 tmp;
P
pbrook 已提交
5678 5679
    TCGv tmp2;

P
pbrook 已提交
5680
    /* Load value and extend to 64 bits.  */
P
pbrook 已提交
5681
    tmp = tcg_temp_new_i64();
P
pbrook 已提交
5682 5683 5684 5685 5686 5687 5688
    tmp2 = load_reg(s, rlow);
    tcg_gen_extu_i32_i64(tmp, tmp2);
    dead_tmp(tmp2);
    tcg_gen_add_i64(val, val, tmp);
}

/* load and add a 64-bit value from a register pair.  */
P
pbrook 已提交
5689
static void gen_addq(DisasContext *s, TCGv_i64 val, int rlow, int rhigh)
P
pbrook 已提交
5690
{
P
pbrook 已提交
5691
    TCGv_i64 tmp;
P
pbrook 已提交
5692 5693
    TCGv tmpl;
    TCGv tmph;
P
pbrook 已提交
5694 5695

    /* Load 64-bit value rd:rn.  */
P
pbrook 已提交
5696 5697
    tmpl = load_reg(s, rlow);
    tmph = load_reg(s, rhigh);
P
pbrook 已提交
5698
    tmp = tcg_temp_new_i64();
P
pbrook 已提交
5699 5700 5701
    tcg_gen_concat_i32_i64(tmp, tmpl, tmph);
    dead_tmp(tmpl);
    dead_tmp(tmph);
P
pbrook 已提交
5702 5703 5704 5705
    tcg_gen_add_i64(val, val, tmp);
}

/* Set N and Z flags from a 64-bit value.  */
P
pbrook 已提交
5706
static void gen_logicq_cc(TCGv_i64 val)
P
pbrook 已提交
5707 5708 5709
{
    TCGv tmp = new_tmp();
    gen_helper_logicq_cc(tmp, val);
P
pbrook 已提交
5710 5711
    gen_logic_CC(tmp);
    dead_tmp(tmp);
P
pbrook 已提交
5712 5713
}

P
pbrook 已提交
5714 5715 5716
static void disas_arm_insn(CPUState * env, DisasContext *s)
{
    unsigned int cond, insn, val, op1, i, shift, rm, rs, rn, rd, sh;
P
pbrook 已提交
5717
    TCGv tmp;
P
pbrook 已提交
5718
    TCGv tmp2;
P
pbrook 已提交
5719
    TCGv tmp3;
P
pbrook 已提交
5720
    TCGv addr;
P
pbrook 已提交
5721
    TCGv_i64 tmp64;
P
pbrook 已提交
5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734 5735 5736 5737 5738 5739 5740 5741 5742 5743 5744 5745 5746 5747 5748 5749 5750 5751 5752 5753 5754 5755 5756 5757 5758 5759 5760 5761 5762 5763

    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 已提交
5764
                gen_helper_clrex(cpu_env);
P
pbrook 已提交
5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775 5776
                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 */
5777
            int32_t offset;
P
pbrook 已提交
5778 5779 5780 5781 5782
            if (IS_USER(s))
                goto illegal_op;
            ARCH(6);
            op1 = (insn & 0x1f);
            if (op1 == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
5783
                addr = load_reg(s, 13);
P
pbrook 已提交
5784
            } else {
P
pbrook 已提交
5785 5786
                addr = new_tmp();
                gen_helper_get_r13_banked(addr, cpu_env, tcg_const_i32(op1));
P
pbrook 已提交
5787 5788 5789 5790
            }
            i = (insn >> 23) & 3;
            switch (i) {
            case 0: offset = -4; break; /* DA */
5791 5792
            case 1: offset = 0; break; /* IA */
            case 2: offset = -8; break; /* DB */
P
pbrook 已提交
5793 5794 5795 5796
            case 3: offset = 4; break; /* IB */
            default: abort();
            }
            if (offset)
P
pbrook 已提交
5797 5798 5799
                tcg_gen_addi_i32(addr, addr, offset);
            tmp = load_reg(s, 14);
            gen_st32(tmp, addr, 0);
5800
            tmp = load_cpu_field(spsr);
P
pbrook 已提交
5801 5802
            tcg_gen_addi_i32(addr, addr, 4);
            gen_st32(tmp, addr, 0);
P
pbrook 已提交
5803 5804 5805 5806
            if (insn & (1 << 21)) {
                /* Base writeback.  */
                switch (i) {
                case 0: offset = -8; break;
5807 5808
                case 1: offset = 4; break;
                case 2: offset = -4; break;
P
pbrook 已提交
5809 5810 5811 5812
                case 3: offset = 0; break;
                default: abort();
                }
                if (offset)
5813
                    tcg_gen_addi_i32(addr, addr, offset);
P
pbrook 已提交
5814
                if (op1 == (env->uncached_cpsr & CPSR_M)) {
5815
                    store_reg(s, 13, addr);
P
pbrook 已提交
5816
                } else {
5817 5818
                    gen_helper_set_r13_banked(cpu_env, tcg_const_i32(op1), addr);
                    dead_tmp(addr);
P
pbrook 已提交
5819
                }
P
pbrook 已提交
5820 5821
            } else {
                dead_tmp(addr);
P
pbrook 已提交
5822 5823 5824
            }
        } else if ((insn & 0x0e5fffe0) == 0x081d0a00) {
            /* rfe */
5825
            int32_t offset;
P
pbrook 已提交
5826 5827 5828 5829
            if (IS_USER(s))
                goto illegal_op;
            ARCH(6);
            rn = (insn >> 16) & 0xf;
P
pbrook 已提交
5830
            addr = load_reg(s, rn);
P
pbrook 已提交
5831 5832
            i = (insn >> 23) & 3;
            switch (i) {
P
pbrook 已提交
5833
            case 0: offset = -4; break; /* DA */
5834 5835
            case 1: offset = 0; break; /* IA */
            case 2: offset = -8; break; /* DB */
P
pbrook 已提交
5836
            case 3: offset = 4; break; /* IB */
P
pbrook 已提交
5837 5838 5839
            default: abort();
            }
            if (offset)
P
pbrook 已提交
5840 5841 5842 5843 5844
                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 已提交
5845 5846 5847
            if (insn & (1 << 21)) {
                /* Base writeback.  */
                switch (i) {
P
pbrook 已提交
5848
                case 0: offset = -8; break;
5849 5850
                case 1: offset = 4; break;
                case 2: offset = -4; break;
P
pbrook 已提交
5851
                case 3: offset = 0; break;
P
pbrook 已提交
5852 5853 5854
                default: abort();
                }
                if (offset)
P
pbrook 已提交
5855 5856 5857 5858
                    tcg_gen_addi_i32(addr, addr, offset);
                store_reg(s, rn, addr);
            } else {
                dead_tmp(addr);
P
pbrook 已提交
5859
            }
P
pbrook 已提交
5860
            gen_rfe(s, tmp, tmp2);
5861
            return;
P
pbrook 已提交
5862 5863 5864 5865 5866
        } else if ((insn & 0x0e000000) == 0x0a000000) {
            /* branch link and change to thumb (blx <offset>) */
            int32_t offset;

            val = (uint32_t)s->pc;
P
pbrook 已提交
5867 5868 5869
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, val);
            store_reg(s, 14, tmp);
P
pbrook 已提交
5870 5871 5872 5873 5874 5875
            /* 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 已提交
5876
            gen_bx_im(s, val);
P
pbrook 已提交
5877 5878 5879 5880 5881 5882 5883 5884 5885 5886 5887 5888
            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 已提交
5889
        } else if ((insn & 0x0ff10020) == 0x01000000) {
P
pbrook 已提交
5890 5891 5892 5893 5894 5895 5896 5897 5898 5899 5900 5901 5902 5903 5904 5905
            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 已提交
5906
            if (insn & (1 << 17)) {
P
pbrook 已提交
5907 5908 5909 5910
                mask |= CPSR_M;
                val |= (insn & 0x1f);
            }
            if (mask) {
5911
                gen_set_psr_im(s, mask, 0, val);
P
pbrook 已提交
5912 5913 5914 5915 5916 5917 5918 5919 5920
            }
            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 已提交
5921
        gen_test_cc(cond ^ 1, s->condlabel);
P
pbrook 已提交
5922 5923 5924 5925 5926 5927 5928 5929 5930
        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 已提交
5931 5932
                tmp = new_tmp();
                tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
5933 5934
            } else {
                /* MOVT */
P
pbrook 已提交
5935
                tmp = load_reg(s, rd);
P
pbrook 已提交
5936
                tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
5937
                tcg_gen_ori_i32(tmp, tmp, val << 16);
P
pbrook 已提交
5938
            }
P
pbrook 已提交
5939
            store_reg(s, rd, tmp);
P
pbrook 已提交
5940 5941 5942 5943 5944 5945 5946 5947 5948 5949 5950 5951
        } 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);
5952
                if (gen_set_psr_im(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, val))
P
pbrook 已提交
5953 5954 5955 5956 5957 5958 5959 5960 5961 5962 5963 5964 5965
                    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 */
5966
                tmp = load_reg(s, rm);
P
pbrook 已提交
5967
                i = ((op1 & 2) != 0);
5968
                if (gen_set_psr(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, tmp))
P
pbrook 已提交
5969 5970 5971 5972 5973 5974 5975
                    goto illegal_op;
            } else {
                /* reg = PSR */
                rd = (insn >> 12) & 0xf;
                if (op1 & 2) {
                    if (IS_USER(s))
                        goto illegal_op;
P
pbrook 已提交
5976
                    tmp = load_cpu_field(spsr);
P
pbrook 已提交
5977
                } else {
P
pbrook 已提交
5978 5979
                    tmp = new_tmp();
                    gen_helper_cpsr_read(tmp);
P
pbrook 已提交
5980
                }
P
pbrook 已提交
5981
                store_reg(s, rd, tmp);
P
pbrook 已提交
5982 5983 5984 5985 5986
            }
            break;
        case 0x1:
            if (op1 == 1) {
                /* branch/exchange thumb (bx).  */
P
pbrook 已提交
5987 5988
                tmp = load_reg(s, rm);
                gen_bx(s, tmp);
P
pbrook 已提交
5989 5990 5991
            } else if (op1 == 3) {
                /* clz */
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
5992 5993 5994
                tmp = load_reg(s, rm);
                gen_helper_clz(tmp, tmp);
                store_reg(s, rd, tmp);
P
pbrook 已提交
5995 5996 5997 5998 5999 6000 6001 6002
            } else {
                goto illegal_op;
            }
            break;
        case 0x2:
            if (op1 == 1) {
                ARCH(5J); /* bxj */
                /* Trivial implementation equivalent to bx.  */
P
pbrook 已提交
6003 6004
                tmp = load_reg(s, rm);
                gen_bx(s, tmp);
P
pbrook 已提交
6005 6006 6007 6008 6009 6010 6011 6012 6013
            } else {
                goto illegal_op;
            }
            break;
        case 0x3:
            if (op1 != 1)
              goto illegal_op;

            /* branch link/exchange thumb (blx) */
P
pbrook 已提交
6014 6015 6016 6017 6018
            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 已提交
6019 6020 6021 6022
            break;
        case 0x5: /* saturating add/subtract */
            rd = (insn >> 12) & 0xf;
            rn = (insn >> 16) & 0xf;
6023
            tmp = load_reg(s, rm);
P
pbrook 已提交
6024
            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6025
            if (op1 & 2)
P
pbrook 已提交
6026
                gen_helper_double_saturate(tmp2, tmp2);
P
pbrook 已提交
6027
            if (op1 & 1)
P
pbrook 已提交
6028
                gen_helper_sub_saturate(tmp, tmp, tmp2);
P
pbrook 已提交
6029
            else
P
pbrook 已提交
6030 6031 6032
                gen_helper_add_saturate(tmp, tmp, tmp2);
            dead_tmp(tmp2);
            store_reg(s, rd, tmp);
P
pbrook 已提交
6033 6034 6035
            break;
        case 7: /* bkpt */
            gen_set_condexec(s);
P
pbrook 已提交
6036
            gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
6037
            gen_exception(EXCP_BKPT);
P
pbrook 已提交
6038 6039 6040 6041 6042 6043 6044 6045 6046 6047 6048
            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 已提交
6049 6050
                tmp = load_reg(s, rm);
                tmp2 = load_reg(s, rs);
P
pbrook 已提交
6051
                if (sh & 4)
P
pbrook 已提交
6052
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
P
pbrook 已提交
6053
                else
P
pbrook 已提交
6054
                    gen_sxth(tmp2);
P
pbrook 已提交
6055 6056
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
                tcg_gen_shri_i64(tmp64, tmp64, 16);
P
pbrook 已提交
6057
                tmp = new_tmp();
P
pbrook 已提交
6058
                tcg_gen_trunc_i64_i32(tmp, tmp64);
P
pbrook 已提交
6059
                if ((sh & 2) == 0) {
P
pbrook 已提交
6060 6061 6062
                    tmp2 = load_reg(s, rn);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
6063
                }
P
pbrook 已提交
6064
                store_reg(s, rd, tmp);
P
pbrook 已提交
6065 6066
            } else {
                /* 16 * 16 */
P
pbrook 已提交
6067 6068 6069 6070
                tmp = load_reg(s, rm);
                tmp2 = load_reg(s, rs);
                gen_mulxy(tmp, tmp2, sh & 2, sh & 4);
                dead_tmp(tmp2);
P
pbrook 已提交
6071
                if (op1 == 2) {
P
pbrook 已提交
6072 6073
                    tmp64 = tcg_temp_new_i64();
                    tcg_gen_ext_i32_i64(tmp64, tmp);
6074
                    dead_tmp(tmp);
P
pbrook 已提交
6075 6076
                    gen_addq(s, tmp64, rn, rd);
                    gen_storeq_reg(s, rn, rd, tmp64);
P
pbrook 已提交
6077 6078
                } else {
                    if (op1 == 0) {
P
pbrook 已提交
6079 6080 6081
                        tmp2 = load_reg(s, rn);
                        gen_helper_add_setq(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
P
pbrook 已提交
6082
                    }
P
pbrook 已提交
6083
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6084 6085 6086 6087 6088 6089 6090 6091 6092 6093 6094 6095 6096 6097 6098 6099 6100 6101 6102 6103
                }
            }
            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;
6104
            if (shift) {
P
pbrook 已提交
6105
                val = (val >> shift) | (val << (32 - shift));
6106 6107 6108 6109 6110 6111
            }
            tmp2 = new_tmp();
            tcg_gen_movi_i32(tmp2, val);
            if (logic_cc && shift) {
                gen_set_CF_bit31(tmp2);
            }
P
pbrook 已提交
6112 6113 6114
        } else {
            /* register */
            rm = (insn) & 0xf;
6115
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
6116 6117 6118
            shiftop = (insn >> 5) & 3;
            if (!(insn & (1 << 4))) {
                shift = (insn >> 7) & 0x1f;
6119
                gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
P
pbrook 已提交
6120 6121
            } else {
                rs = (insn >> 8) & 0xf;
P
pbrook 已提交
6122
                tmp = load_reg(s, rs);
6123
                gen_arm_shift_reg(tmp2, shiftop, tmp, logic_cc);
P
pbrook 已提交
6124 6125 6126 6127
            }
        }
        if (op1 != 0x0f && op1 != 0x0d) {
            rn = (insn >> 16) & 0xf;
6128 6129 6130
            tmp = load_reg(s, rn);
        } else {
            TCGV_UNUSED(tmp);
P
pbrook 已提交
6131 6132 6133 6134
        }
        rd = (insn >> 12) & 0xf;
        switch(op1) {
        case 0x00:
6135 6136 6137 6138
            tcg_gen_and_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6139
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6140 6141
            break;
        case 0x01:
6142 6143 6144 6145
            tcg_gen_xor_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6146
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6147 6148 6149 6150
            break;
        case 0x02:
            if (set_cc && rd == 15) {
                /* SUBS r15, ... is used for exception return.  */
6151
                if (IS_USER(s)) {
P
pbrook 已提交
6152
                    goto illegal_op;
6153 6154 6155
                }
                gen_helper_sub_cc(tmp, tmp, tmp2);
                gen_exception_return(s, tmp);
P
pbrook 已提交
6156
            } else {
6157 6158 6159 6160 6161
                if (set_cc) {
                    gen_helper_sub_cc(tmp, tmp, tmp2);
                } else {
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
                }
6162
                store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6163 6164 6165
            }
            break;
        case 0x03:
6166 6167 6168 6169 6170
            if (set_cc) {
                gen_helper_sub_cc(tmp, tmp2, tmp);
            } else {
                tcg_gen_sub_i32(tmp, tmp2, tmp);
            }
6171
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6172 6173
            break;
        case 0x04:
6174 6175 6176 6177 6178
            if (set_cc) {
                gen_helper_add_cc(tmp, tmp, tmp2);
            } else {
                tcg_gen_add_i32(tmp, tmp, tmp2);
            }
6179
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6180 6181
            break;
        case 0x05:
6182 6183 6184 6185 6186
            if (set_cc) {
                gen_helper_adc_cc(tmp, tmp, tmp2);
            } else {
                gen_add_carry(tmp, tmp, tmp2);
            }
6187
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6188 6189
            break;
        case 0x06:
6190 6191 6192 6193 6194
            if (set_cc) {
                gen_helper_sbc_cc(tmp, tmp, tmp2);
            } else {
                gen_sub_carry(tmp, tmp, tmp2);
            }
6195
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6196 6197
            break;
        case 0x07:
6198 6199 6200 6201 6202
            if (set_cc) {
                gen_helper_sbc_cc(tmp, tmp2, tmp);
            } else {
                gen_sub_carry(tmp, tmp2, tmp);
            }
6203
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6204 6205 6206
            break;
        case 0x08:
            if (set_cc) {
6207 6208
                tcg_gen_and_i32(tmp, tmp, tmp2);
                gen_logic_CC(tmp);
P
pbrook 已提交
6209
            }
6210
            dead_tmp(tmp);
P
pbrook 已提交
6211 6212 6213
            break;
        case 0x09:
            if (set_cc) {
6214 6215
                tcg_gen_xor_i32(tmp, tmp, tmp2);
                gen_logic_CC(tmp);
P
pbrook 已提交
6216
            }
6217
            dead_tmp(tmp);
P
pbrook 已提交
6218 6219 6220
            break;
        case 0x0a:
            if (set_cc) {
6221
                gen_helper_sub_cc(tmp, tmp, tmp2);
P
pbrook 已提交
6222
            }
6223
            dead_tmp(tmp);
P
pbrook 已提交
6224 6225 6226
            break;
        case 0x0b:
            if (set_cc) {
6227
                gen_helper_add_cc(tmp, tmp, tmp2);
P
pbrook 已提交
6228
            }
6229
            dead_tmp(tmp);
P
pbrook 已提交
6230 6231
            break;
        case 0x0c:
6232 6233 6234 6235
            tcg_gen_or_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6236
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6237 6238 6239 6240
            break;
        case 0x0d:
            if (logic_cc && rd == 15) {
                /* MOVS r15, ... is used for exception return.  */
6241
                if (IS_USER(s)) {
P
pbrook 已提交
6242
                    goto illegal_op;
6243 6244
                }
                gen_exception_return(s, tmp2);
P
pbrook 已提交
6245
            } else {
6246 6247 6248
                if (logic_cc) {
                    gen_logic_CC(tmp2);
                }
6249
                store_reg_bx(env, s, rd, tmp2);
P
pbrook 已提交
6250 6251 6252
            }
            break;
        case 0x0e:
6253 6254 6255 6256
            tcg_gen_bic_i32(tmp, tmp, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp);
            }
6257
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
6258 6259 6260
            break;
        default:
        case 0x0f:
6261 6262 6263 6264
            tcg_gen_not_i32(tmp2, tmp2);
            if (logic_cc) {
                gen_logic_CC(tmp2);
            }
6265
            store_reg_bx(env, s, rd, tmp2);
P
pbrook 已提交
6266 6267
            break;
        }
6268 6269 6270
        if (op1 != 0x0f && op1 != 0x0d) {
            dead_tmp(tmp2);
        }
P
pbrook 已提交
6271 6272 6273 6274 6275 6276 6277 6278 6279 6280 6281 6282 6283 6284 6285 6286 6287 6288
    } 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 已提交
6289 6290 6291 6292
                        tmp = load_reg(s, rs);
                        tmp2 = load_reg(s, rm);
                        tcg_gen_mul_i32(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
P
pbrook 已提交
6293 6294 6295
                        if (insn & (1 << 22)) {
                            /* Subtract (mls) */
                            ARCH(6T2);
P
pbrook 已提交
6296 6297 6298
                            tmp2 = load_reg(s, rn);
                            tcg_gen_sub_i32(tmp, tmp2, tmp);
                            dead_tmp(tmp2);
P
pbrook 已提交
6299 6300
                        } else if (insn & (1 << 21)) {
                            /* Add */
P
pbrook 已提交
6301 6302 6303
                            tmp2 = load_reg(s, rn);
                            tcg_gen_add_i32(tmp, tmp, tmp2);
                            dead_tmp(tmp2);
P
pbrook 已提交
6304 6305
                        }
                        if (insn & (1 << 20))
P
pbrook 已提交
6306 6307
                            gen_logic_CC(tmp);
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6308 6309 6310
                        break;
                    default:
                        /* 64 bit mul */
P
pbrook 已提交
6311 6312
                        tmp = load_reg(s, rs);
                        tmp2 = load_reg(s, rm);
P
pbrook 已提交
6313
                        if (insn & (1 << 22))
P
pbrook 已提交
6314
                            tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
6315
                        else
P
pbrook 已提交
6316
                            tmp64 = gen_mulu_i64_i32(tmp, tmp2);
P
pbrook 已提交
6317
                        if (insn & (1 << 21)) /* mult accumulate */
P
pbrook 已提交
6318
                            gen_addq(s, tmp64, rn, rd);
P
pbrook 已提交
6319 6320
                        if (!(insn & (1 << 23))) { /* double accumulate */
                            ARCH(6);
P
pbrook 已提交
6321 6322
                            gen_addq_lo(s, tmp64, rn);
                            gen_addq_lo(s, tmp64, rd);
P
pbrook 已提交
6323 6324
                        }
                        if (insn & (1 << 20))
P
pbrook 已提交
6325 6326
                            gen_logicq_cc(tmp64);
                        gen_storeq_reg(s, rn, rd, tmp64);
P
pbrook 已提交
6327 6328 6329 6330 6331 6332 6333
                        break;
                    }
                } else {
                    rn = (insn >> 16) & 0xf;
                    rd = (insn >> 12) & 0xf;
                    if (insn & (1 << 23)) {
                        /* load/store exclusive */
P
pbrook 已提交
6334 6335
                        op1 = (insn >> 21) & 0x3;
                        if (op1)
6336
                            ARCH(6K);
P
pbrook 已提交
6337 6338
                        else
                            ARCH(6);
6339 6340
                        addr = tcg_temp_local_new_i32();
                        tcg_gen_mov_i32(addr, cpu_R[rn]);
P
pbrook 已提交
6341
                        if (insn & (1 << 20)) {
6342
                            gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
6343 6344 6345 6346 6347 6348 6349 6350 6351 6352 6353 6354 6355 6356 6357 6358 6359 6360 6361 6362
                            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 已提交
6363
                            store_reg(s, rd, tmp);
P
pbrook 已提交
6364
                        } else {
P
pbrook 已提交
6365
                            int label = gen_new_label();
P
pbrook 已提交
6366
                            rm = insn & 0xf;
6367 6368 6369
                            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 已提交
6370
                            tmp = load_reg(s,rm);
P
pbrook 已提交
6371 6372 6373 6374 6375 6376 6377 6378 6379 6380 6381 6382 6383 6384 6385 6386 6387 6388 6389
                            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 已提交
6390
                            gen_set_label(label);
6391 6392
                            tcg_gen_mov_i32(cpu_R[rd], tmp2);
                            tcg_temp_free(tmp2);
P
pbrook 已提交
6393
                        }
6394
                        tcg_temp_free(addr);
P
pbrook 已提交
6395 6396 6397 6398
                    } else {
                        /* SWP instruction */
                        rm = (insn) & 0xf;

P
pbrook 已提交
6399 6400 6401 6402 6403
                        /* ??? 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 已提交
6404
                        if (insn & (1 << 22)) {
P
pbrook 已提交
6405 6406
                            tmp2 = gen_ld8u(addr, IS_USER(s));
                            gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
6407
                        } else {
P
pbrook 已提交
6408 6409
                            tmp2 = gen_ld32(addr, IS_USER(s));
                            gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
6410
                        }
P
pbrook 已提交
6411 6412
                        dead_tmp(addr);
                        store_reg(s, rd, tmp2);
P
pbrook 已提交
6413 6414 6415 6416 6417 6418 6419 6420
                    }
                }
            } else {
                int address_offset;
                int load;
                /* Misc load/store */
                rn = (insn >> 16) & 0xf;
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6421
                addr = load_reg(s, rn);
P
pbrook 已提交
6422
                if (insn & (1 << 24))
P
pbrook 已提交
6423
                    gen_add_datah_offset(s, insn, 0, addr);
P
pbrook 已提交
6424 6425 6426 6427 6428
                address_offset = 0;
                if (insn & (1 << 20)) {
                    /* load */
                    switch(sh) {
                    case 1:
P
pbrook 已提交
6429
                        tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
6430 6431
                        break;
                    case 2:
P
pbrook 已提交
6432
                        tmp = gen_ld8s(addr, IS_USER(s));
P
pbrook 已提交
6433 6434 6435
                        break;
                    default:
                    case 3:
P
pbrook 已提交
6436
                        tmp = gen_ld16s(addr, IS_USER(s));
P
pbrook 已提交
6437 6438 6439 6440 6441 6442 6443
                        break;
                    }
                    load = 1;
                } else if (sh & 2) {
                    /* doubleword */
                    if (sh & 1) {
                        /* store */
P
pbrook 已提交
6444 6445 6446 6447 6448
                        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 已提交
6449 6450 6451
                        load = 0;
                    } else {
                        /* load */
P
pbrook 已提交
6452 6453 6454 6455
                        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 已提交
6456 6457 6458 6459 6460 6461
                        rd++;
                        load = 1;
                    }
                    address_offset = -4;
                } else {
                    /* store */
P
pbrook 已提交
6462 6463
                    tmp = load_reg(s, rd);
                    gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
6464 6465 6466 6467 6468 6469 6470
                    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 已提交
6471 6472
                    gen_add_datah_offset(s, insn, address_offset, addr);
                    store_reg(s, rn, addr);
P
pbrook 已提交
6473 6474
                } else if (insn & (1 << 21)) {
                    if (address_offset)
P
pbrook 已提交
6475 6476 6477 6478
                        tcg_gen_addi_i32(addr, addr, address_offset);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
6479 6480 6481
                }
                if (load) {
                    /* Complete the load.  */
P
pbrook 已提交
6482
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6483 6484 6485 6486 6487 6488 6489 6490 6491 6492 6493 6494 6495
                }
            }
            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 已提交
6496
                rd = (insn >> 12) & 0xf;
P
pbrook 已提交
6497 6498 6499 6500
                rs = (insn >> 8) & 0xf;
                switch ((insn >> 23) & 3) {
                case 0: /* Parallel add/subtract.  */
                    op1 = (insn >> 20) & 7;
P
pbrook 已提交
6501 6502
                    tmp = load_reg(s, rn);
                    tmp2 = load_reg(s, rm);
P
pbrook 已提交
6503 6504 6505
                    sh = (insn >> 5) & 7;
                    if ((op1 & 3) == 0 || sh == 5 || sh == 6)
                        goto illegal_op;
P
pbrook 已提交
6506 6507 6508
                    gen_arm_parallel_addsub(op1, sh, tmp, tmp2);
                    dead_tmp(tmp2);
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6509 6510 6511
                    break;
                case 1:
                    if ((insn & 0x00700020) == 0) {
B
balrog 已提交
6512
                        /* Halfword pack.  */
P
pbrook 已提交
6513 6514
                        tmp = load_reg(s, rn);
                        tmp2 = load_reg(s, rm);
P
pbrook 已提交
6515
                        shift = (insn >> 7) & 0x1f;
P
pbrook 已提交
6516 6517
                        if (insn & (1 << 6)) {
                            /* pkhtb */
6518 6519 6520
                            if (shift == 0)
                                shift = 31;
                            tcg_gen_sari_i32(tmp2, tmp2, shift);
P
pbrook 已提交
6521
                            tcg_gen_andi_i32(tmp, tmp, 0xffff0000);
P
pbrook 已提交
6522
                            tcg_gen_ext16u_i32(tmp2, tmp2);
P
pbrook 已提交
6523 6524
                        } else {
                            /* pkhbt */
6525 6526
                            if (shift)
                                tcg_gen_shli_i32(tmp2, tmp2, shift);
P
pbrook 已提交
6527
                            tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
6528 6529 6530
                            tcg_gen_andi_i32(tmp2, tmp2, 0xffff0000);
                        }
                        tcg_gen_or_i32(tmp, tmp, tmp2);
6531
                        dead_tmp(tmp2);
P
pbrook 已提交
6532
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6533 6534
                    } else if ((insn & 0x00200020) == 0x00200000) {
                        /* [us]sat */
P
pbrook 已提交
6535
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6536 6537 6538 6539
                        shift = (insn >> 7) & 0x1f;
                        if (insn & (1 << 6)) {
                            if (shift == 0)
                                shift = 31;
P
pbrook 已提交
6540
                            tcg_gen_sari_i32(tmp, tmp, shift);
P
pbrook 已提交
6541
                        } else {
P
pbrook 已提交
6542
                            tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
6543 6544 6545 6546
                        }
                        sh = (insn >> 16) & 0x1f;
                        if (sh != 0) {
                            if (insn & (1 << 22))
P
pbrook 已提交
6547
                                gen_helper_usat(tmp, tmp, tcg_const_i32(sh));
P
pbrook 已提交
6548
                            else
P
pbrook 已提交
6549
                                gen_helper_ssat(tmp, tmp, tcg_const_i32(sh));
P
pbrook 已提交
6550
                        }
P
pbrook 已提交
6551
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6552 6553
                    } else if ((insn & 0x00300fe0) == 0x00200f20) {
                        /* [us]sat16 */
P
pbrook 已提交
6554
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6555 6556 6557
                        sh = (insn >> 16) & 0x1f;
                        if (sh != 0) {
                            if (insn & (1 << 22))
P
pbrook 已提交
6558
                                gen_helper_usat16(tmp, tmp, tcg_const_i32(sh));
P
pbrook 已提交
6559
                            else
P
pbrook 已提交
6560
                                gen_helper_ssat16(tmp, tmp, tcg_const_i32(sh));
P
pbrook 已提交
6561
                        }
P
pbrook 已提交
6562
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6563 6564
                    } else if ((insn & 0x00700fe0) == 0x00000fa0) {
                        /* Select bytes.  */
P
pbrook 已提交
6565 6566 6567 6568 6569 6570 6571 6572
                        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 已提交
6573
                    } else if ((insn & 0x000003e0) == 0x00000060) {
P
pbrook 已提交
6574
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6575 6576 6577 6578
                        shift = (insn >> 10) & 3;
                        /* ??? In many cases it's not neccessary to do a
                           rotate, a shift is sufficient.  */
                        if (shift != 0)
P
pbrook 已提交
6579
                            tcg_gen_rori_i32(tmp, tmp, shift * 8);
P
pbrook 已提交
6580 6581
                        op1 = (insn >> 20) & 7;
                        switch (op1) {
P
pbrook 已提交
6582 6583 6584 6585 6586 6587
                        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 已提交
6588 6589 6590
                        default: goto illegal_op;
                        }
                        if (rn != 15) {
P
pbrook 已提交
6591
                            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6592
                            if ((op1 & 3) == 0) {
P
pbrook 已提交
6593
                                gen_add16(tmp, tmp2);
P
pbrook 已提交
6594
                            } else {
P
pbrook 已提交
6595 6596
                                tcg_gen_add_i32(tmp, tmp, tmp2);
                                dead_tmp(tmp2);
P
pbrook 已提交
6597 6598
                            }
                        }
B
balrog 已提交
6599
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6600 6601
                    } else if ((insn & 0x003f0f60) == 0x003f0f20) {
                        /* rev */
P
pbrook 已提交
6602
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6603 6604
                        if (insn & (1 << 22)) {
                            if (insn & (1 << 7)) {
P
pbrook 已提交
6605
                                gen_revsh(tmp);
P
pbrook 已提交
6606 6607
                            } else {
                                ARCH(6T2);
P
pbrook 已提交
6608
                                gen_helper_rbit(tmp, tmp);
P
pbrook 已提交
6609 6610 6611
                            }
                        } else {
                            if (insn & (1 << 7))
P
pbrook 已提交
6612
                                gen_rev16(tmp);
P
pbrook 已提交
6613
                            else
A
aurel32 已提交
6614
                                tcg_gen_bswap32_i32(tmp, tmp);
P
pbrook 已提交
6615
                        }
P
pbrook 已提交
6616
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6617 6618 6619 6620 6621
                    } else {
                        goto illegal_op;
                    }
                    break;
                case 2: /* Multiplies (Type 3).  */
P
pbrook 已提交
6622 6623
                    tmp = load_reg(s, rm);
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
6624 6625
                    if (insn & (1 << 20)) {
                        /* Signed multiply most significant [accumulate].  */
P
pbrook 已提交
6626
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
6627
                        if (insn & (1 << 5))
P
pbrook 已提交
6628 6629
                            tcg_gen_addi_i64(tmp64, tmp64, 0x80000000u);
                        tcg_gen_shri_i64(tmp64, tmp64, 32);
P
pbrook 已提交
6630
                        tmp = new_tmp();
P
pbrook 已提交
6631
                        tcg_gen_trunc_i64_i32(tmp, tmp64);
6632 6633
                        if (rd != 15) {
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6634
                            if (insn & (1 << 6)) {
P
pbrook 已提交
6635
                                tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
6636
                            } else {
P
pbrook 已提交
6637
                                tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
6638
                            }
P
pbrook 已提交
6639
                            dead_tmp(tmp2);
P
pbrook 已提交
6640
                        }
6641
                        store_reg(s, rn, tmp);
P
pbrook 已提交
6642 6643
                    } else {
                        if (insn & (1 << 5))
P
pbrook 已提交
6644 6645 6646 6647 6648 6649 6650 6651 6652
                            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 已提交
6653
                        if (insn & (1 << 22)) {
P
pbrook 已提交
6654
                            /* smlald, smlsld */
P
pbrook 已提交
6655 6656
                            tmp64 = tcg_temp_new_i64();
                            tcg_gen_ext_i32_i64(tmp64, tmp);
P
pbrook 已提交
6657
                            dead_tmp(tmp);
P
pbrook 已提交
6658 6659
                            gen_addq(s, tmp64, rd, rn);
                            gen_storeq_reg(s, rd, rn, tmp64);
P
pbrook 已提交
6660
                        } else {
P
pbrook 已提交
6661
                            /* smuad, smusd, smlad, smlsd */
6662
                            if (rd != 15)
P
pbrook 已提交
6663
                              {
6664
                                tmp2 = load_reg(s, rd);
P
pbrook 已提交
6665 6666
                                gen_helper_add_setq(tmp, tmp, tmp2);
                                dead_tmp(tmp2);
P
pbrook 已提交
6667
                              }
6668
                            store_reg(s, rn, tmp);
P
pbrook 已提交
6669 6670 6671 6672 6673 6674 6675
                        }
                    }
                    break;
                case 3:
                    op1 = ((insn >> 17) & 0x38) | ((insn >> 5) & 7);
                    switch (op1) {
                    case 0: /* Unsigned sum of absolute differences.  */
P
pbrook 已提交
6676 6677 6678 6679 6680
                        ARCH(6);
                        tmp = load_reg(s, rm);
                        tmp2 = load_reg(s, rs);
                        gen_helper_usad8(tmp, tmp, tmp2);
                        dead_tmp(tmp2);
6681 6682
                        if (rd != 15) {
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6683 6684
                            tcg_gen_add_i32(tmp, tmp, tmp2);
                            dead_tmp(tmp2);
P
pbrook 已提交
6685
                        }
6686
                        store_reg(s, rn, tmp);
P
pbrook 已提交
6687 6688 6689 6690 6691 6692 6693 6694
                        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 已提交
6695 6696
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
6697
                        } else {
P
pbrook 已提交
6698
                            tmp = load_reg(s, rm);
P
pbrook 已提交
6699 6700
                        }
                        if (i != 32) {
P
pbrook 已提交
6701
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
6702
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << i) - 1);
P
pbrook 已提交
6703
                            dead_tmp(tmp2);
P
pbrook 已提交
6704
                        }
P
pbrook 已提交
6705
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6706 6707 6708
                        break;
                    case 0x12: case 0x16: case 0x1a: case 0x1e: /* sbfx */
                    case 0x32: case 0x36: case 0x3a: case 0x3e: /* ubfx */
6709
                        ARCH(6T2);
P
pbrook 已提交
6710
                        tmp = load_reg(s, rm);
P
pbrook 已提交
6711 6712 6713 6714 6715 6716
                        shift = (insn >> 7) & 0x1f;
                        i = ((insn >> 16) & 0x1f) + 1;
                        if (shift + i > 32)
                            goto illegal_op;
                        if (i < 32) {
                            if (op1 & 0x20) {
P
pbrook 已提交
6717
                                gen_ubfx(tmp, shift, (1u << i) - 1);
P
pbrook 已提交
6718
                            } else {
P
pbrook 已提交
6719
                                gen_sbfx(tmp, shift, i);
P
pbrook 已提交
6720 6721
                            }
                        }
P
pbrook 已提交
6722
                        store_reg(s, rd, tmp);
P
pbrook 已提交
6723 6724 6725 6726 6727 6728 6729 6730 6731 6732 6733 6734 6735 6736 6737 6738 6739 6740 6741 6742 6743
                        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 已提交
6744
            tmp2 = load_reg(s, rn);
P
pbrook 已提交
6745 6746
            i = (IS_USER(s) || (insn & 0x01200000) == 0x00200000);
            if (insn & (1 << 24))
P
pbrook 已提交
6747
                gen_add_data_offset(s, insn, tmp2);
P
pbrook 已提交
6748 6749 6750
            if (insn & (1 << 20)) {
                /* load */
                if (insn & (1 << 22)) {
P
pbrook 已提交
6751
                    tmp = gen_ld8u(tmp2, i);
P
pbrook 已提交
6752
                } else {
P
pbrook 已提交
6753
                    tmp = gen_ld32(tmp2, i);
P
pbrook 已提交
6754 6755 6756
                }
            } else {
                /* store */
P
pbrook 已提交
6757
                tmp = load_reg(s, rd);
P
pbrook 已提交
6758
                if (insn & (1 << 22))
P
pbrook 已提交
6759
                    gen_st8(tmp, tmp2, i);
P
pbrook 已提交
6760
                else
P
pbrook 已提交
6761
                    gen_st32(tmp, tmp2, i);
P
pbrook 已提交
6762 6763
            }
            if (!(insn & (1 << 24))) {
P
pbrook 已提交
6764 6765 6766 6767 6768 6769
                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 已提交
6770 6771 6772 6773
            }
            if (insn & (1 << 20)) {
                /* Complete the load.  */
                if (rd == 15)
P
pbrook 已提交
6774
                    gen_bx(s, tmp);
P
pbrook 已提交
6775
                else
P
pbrook 已提交
6776
                    store_reg(s, rd, tmp);
P
pbrook 已提交
6777 6778 6779 6780 6781 6782
            }
            break;
        case 0x08:
        case 0x09:
            {
                int j, n, user, loaded_base;
P
pbrook 已提交
6783
                TCGv loaded_var;
P
pbrook 已提交
6784 6785 6786 6787 6788 6789 6790 6791 6792 6793 6794
                /* 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 已提交
6795
                addr = load_reg(s, rn);
P
pbrook 已提交
6796 6797 6798

                /* compute total size */
                loaded_base = 0;
P
pbrook 已提交
6799
                TCGV_UNUSED(loaded_var);
P
pbrook 已提交
6800 6801 6802 6803 6804 6805 6806 6807 6808
                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 已提交
6809
                        tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6810 6811 6812 6813 6814 6815
                    } else {
                        /* post increment */
                    }
                } else {
                    if (insn & (1 << 24)) {
                        /* pre decrement */
P
pbrook 已提交
6816
                        tcg_gen_addi_i32(addr, addr, -(n * 4));
P
pbrook 已提交
6817 6818 6819
                    } else {
                        /* post decrement */
                        if (n != 1)
P
pbrook 已提交
6820
                        tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
P
pbrook 已提交
6821 6822 6823 6824 6825 6826 6827
                    }
                }
                j = 0;
                for(i=0;i<16;i++) {
                    if (insn & (1 << i)) {
                        if (insn & (1 << 20)) {
                            /* load */
P
pbrook 已提交
6828
                            tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
6829
                            if (i == 15) {
P
pbrook 已提交
6830
                                gen_bx(s, tmp);
P
pbrook 已提交
6831
                            } else if (user) {
P
pbrook 已提交
6832 6833
                                gen_helper_set_user_reg(tcg_const_i32(i), tmp);
                                dead_tmp(tmp);
P
pbrook 已提交
6834
                            } else if (i == rn) {
P
pbrook 已提交
6835
                                loaded_var = tmp;
P
pbrook 已提交
6836 6837
                                loaded_base = 1;
                            } else {
P
pbrook 已提交
6838
                                store_reg(s, i, tmp);
P
pbrook 已提交
6839 6840 6841 6842 6843 6844
                            }
                        } else {
                            /* store */
                            if (i == 15) {
                                /* special case: r15 = PC + 8 */
                                val = (long)s->pc + 4;
P
pbrook 已提交
6845 6846
                                tmp = new_tmp();
                                tcg_gen_movi_i32(tmp, val);
P
pbrook 已提交
6847
                            } else if (user) {
P
pbrook 已提交
6848 6849
                                tmp = new_tmp();
                                gen_helper_get_user_reg(tmp, tcg_const_i32(i));
P
pbrook 已提交
6850
                            } else {
P
pbrook 已提交
6851
                                tmp = load_reg(s, i);
P
pbrook 已提交
6852
                            }
P
pbrook 已提交
6853
                            gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
6854 6855 6856 6857
                        }
                        j++;
                        /* no need to add after the last transfer */
                        if (j != n)
P
pbrook 已提交
6858
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6859 6860 6861 6862 6863 6864 6865 6866 6867
                    }
                }
                if (insn & (1 << 21)) {
                    /* write back */
                    if (insn & (1 << 23)) {
                        if (insn & (1 << 24)) {
                            /* pre increment */
                        } else {
                            /* post increment */
P
pbrook 已提交
6868
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
6869 6870 6871 6872 6873
                        }
                    } else {
                        if (insn & (1 << 24)) {
                            /* pre decrement */
                            if (n != 1)
P
pbrook 已提交
6874
                                tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
P
pbrook 已提交
6875 6876
                        } else {
                            /* post decrement */
P
pbrook 已提交
6877
                            tcg_gen_addi_i32(addr, addr, -(n * 4));
P
pbrook 已提交
6878 6879
                        }
                    }
P
pbrook 已提交
6880 6881 6882
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
6883 6884
                }
                if (loaded_base) {
P
pbrook 已提交
6885
                    store_reg(s, rn, loaded_var);
P
pbrook 已提交
6886 6887 6888
                }
                if ((insn & (1 << 22)) && !user) {
                    /* Restore CPSR from SPSR.  */
P
pbrook 已提交
6889 6890 6891
                    tmp = load_cpu_field(spsr);
                    gen_set_cpsr(tmp, 0xffffffff);
                    dead_tmp(tmp);
P
pbrook 已提交
6892 6893 6894 6895 6896 6897 6898 6899 6900 6901 6902 6903
                    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 已提交
6904 6905 6906
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, val);
                    store_reg(s, 14, tmp);
P
pbrook 已提交
6907 6908 6909 6910 6911 6912 6913 6914 6915 6916 6917 6918 6919 6920 6921
                }
                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 已提交
6922
            gen_set_pc_im(s->pc);
P
pbrook 已提交
6923 6924 6925 6926 6927
            s->is_jmp = DISAS_SWI;
            break;
        default:
        illegal_op:
            gen_set_condexec(s);
P
pbrook 已提交
6928
            gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
6929
            gen_exception(EXCP_UDEF);
P
pbrook 已提交
6930 6931 6932 6933 6934 6935 6936 6937 6938 6939 6940 6941 6942 6943 6944 6945 6946 6947 6948 6949
            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
6950
gen_thumb2_data_op(DisasContext *s, int op, int conds, uint32_t shifter_out, TCGv t0, TCGv t1)
P
pbrook 已提交
6951 6952 6953 6954 6955 6956
{
    int logic_cc;

    logic_cc = 0;
    switch (op) {
    case 0: /* and */
6957
        tcg_gen_and_i32(t0, t0, t1);
P
pbrook 已提交
6958 6959 6960
        logic_cc = conds;
        break;
    case 1: /* bic */
6961
        tcg_gen_bic_i32(t0, t0, t1);
P
pbrook 已提交
6962 6963 6964
        logic_cc = conds;
        break;
    case 2: /* orr */
6965
        tcg_gen_or_i32(t0, t0, t1);
P
pbrook 已提交
6966 6967 6968
        logic_cc = conds;
        break;
    case 3: /* orn */
6969 6970
        tcg_gen_not_i32(t1, t1);
        tcg_gen_or_i32(t0, t0, t1);
P
pbrook 已提交
6971 6972 6973
        logic_cc = conds;
        break;
    case 4: /* eor */
6974
        tcg_gen_xor_i32(t0, t0, t1);
P
pbrook 已提交
6975 6976 6977 6978
        logic_cc = conds;
        break;
    case 8: /* add */
        if (conds)
6979
            gen_helper_add_cc(t0, t0, t1);
P
pbrook 已提交
6980
        else
6981
            tcg_gen_add_i32(t0, t0, t1);
P
pbrook 已提交
6982 6983 6984
        break;
    case 10: /* adc */
        if (conds)
6985
            gen_helper_adc_cc(t0, t0, t1);
P
pbrook 已提交
6986
        else
6987
            gen_adc(t0, t1);
P
pbrook 已提交
6988 6989 6990
        break;
    case 11: /* sbc */
        if (conds)
6991
            gen_helper_sbc_cc(t0, t0, t1);
P
pbrook 已提交
6992
        else
6993
            gen_sub_carry(t0, t0, t1);
P
pbrook 已提交
6994 6995 6996
        break;
    case 13: /* sub */
        if (conds)
6997
            gen_helper_sub_cc(t0, t0, t1);
P
pbrook 已提交
6998
        else
6999
            tcg_gen_sub_i32(t0, t0, t1);
P
pbrook 已提交
7000 7001 7002
        break;
    case 14: /* rsb */
        if (conds)
7003
            gen_helper_sub_cc(t0, t1, t0);
P
pbrook 已提交
7004
        else
7005
            tcg_gen_sub_i32(t0, t1, t0);
P
pbrook 已提交
7006 7007 7008 7009 7010
        break;
    default: /* 5, 6, 7, 9, 12, 15. */
        return 1;
    }
    if (logic_cc) {
7011
        gen_logic_CC(t0);
P
pbrook 已提交
7012
        if (shifter_out)
7013
            gen_set_CF_bit31(t1);
P
pbrook 已提交
7014 7015 7016 7017 7018 7019 7020 7021
    }
    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 已提交
7022
    uint32_t insn, imm, shift, offset;
P
pbrook 已提交
7023
    uint32_t rd, rn, rm, rs;
P
pbrook 已提交
7024
    TCGv tmp;
P
pbrook 已提交
7025 7026
    TCGv tmp2;
    TCGv tmp3;
P
pbrook 已提交
7027
    TCGv addr;
P
pbrook 已提交
7028
    TCGv_i64 tmp64;
P
pbrook 已提交
7029 7030 7031 7032 7033 7034 7035
    int op;
    int shiftop;
    int conds;
    int logic_cc;

    if (!(arm_feature(env, ARM_FEATURE_THUMB2)
          || arm_feature (env, ARM_FEATURE_M))) {
7036
        /* Thumb-1 cores may need to treat bl and blx as a pair of
P
pbrook 已提交
7037 7038 7039 7040 7041
           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 已提交
7042 7043 7044
            tmp = load_reg(s, 14);
            tcg_gen_addi_i32(tmp, tmp, offset);
            tcg_gen_andi_i32(tmp, tmp, 0xfffffffc);
P
pbrook 已提交
7045

P
pbrook 已提交
7046
            tmp2 = new_tmp();
P
pbrook 已提交
7047
            tcg_gen_movi_i32(tmp2, s->pc | 1);
P
pbrook 已提交
7048 7049
            store_reg(s, 14, tmp2);
            gen_bx(s, tmp);
P
pbrook 已提交
7050 7051 7052 7053 7054
            return 0;
        }
        if (insn & (1 << 11)) {
            /* Second half of bl.  */
            offset = ((insn & 0x7ff) << 1) | 1;
P
pbrook 已提交
7055
            tmp = load_reg(s, 14);
B
balrog 已提交
7056
            tcg_gen_addi_i32(tmp, tmp, offset);
P
pbrook 已提交
7057

P
pbrook 已提交
7058
            tmp2 = new_tmp();
P
pbrook 已提交
7059
            tcg_gen_movi_i32(tmp2, s->pc | 1);
P
pbrook 已提交
7060 7061
            store_reg(s, 14, tmp2);
            gen_bx(s, tmp);
P
pbrook 已提交
7062 7063 7064 7065 7066 7067 7068
            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;
7069
            tcg_gen_movi_i32(cpu_R[14], s->pc + 2 + offset);
P
pbrook 已提交
7070 7071 7072 7073 7074 7075 7076 7077 7078 7079 7080 7081 7082 7083 7084 7085 7086 7087 7088 7089 7090 7091 7092 7093 7094 7095 7096
            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 已提交
7097 7098
                    addr = new_tmp();
                    tcg_gen_movi_i32(addr, s->pc & ~3);
P
pbrook 已提交
7099
                } else {
P
pbrook 已提交
7100
                    addr = load_reg(s, rn);
P
pbrook 已提交
7101 7102 7103 7104 7105
                }
                offset = (insn & 0xff) * 4;
                if ((insn & (1 << 23)) == 0)
                    offset = -offset;
                if (insn & (1 << 24)) {
P
pbrook 已提交
7106
                    tcg_gen_addi_i32(addr, addr, offset);
P
pbrook 已提交
7107 7108 7109 7110
                    offset = 0;
                }
                if (insn & (1 << 20)) {
                    /* ldrd */
P
pbrook 已提交
7111 7112 7113 7114 7115
                    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 已提交
7116 7117
                } else {
                    /* strd */
P
pbrook 已提交
7118 7119 7120 7121 7122
                    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 已提交
7123 7124 7125 7126 7127
                }
                if (insn & (1 << 21)) {
                    /* Base writeback.  */
                    if (rn == 15)
                        goto illegal_op;
P
pbrook 已提交
7128 7129 7130 7131
                    tcg_gen_addi_i32(addr, addr, offset - 4);
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
7132 7133 7134
                }
            } else if ((insn & (1 << 23)) == 0) {
                /* Load/store exclusive word.  */
7135 7136
                addr = tcg_temp_local_new();
                tcg_gen_mov_i32(addr, cpu_R[rn]);
B
bellard 已提交
7137
                if (insn & (1 << 20)) {
7138
                    gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
7139 7140
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7141
                } else {
P
pbrook 已提交
7142
                    int label = gen_new_label();
7143 7144 7145
                    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 已提交
7146
                    tmp = load_reg(s, rs);
7147
                    gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
7148
                    gen_set_label(label);
7149 7150
                    tcg_gen_mov_i32(cpu_R[rd], tmp2);
                    tcg_temp_free(tmp2);
P
pbrook 已提交
7151
                }
7152
                tcg_temp_free(addr);
P
pbrook 已提交
7153 7154 7155
            } else if ((insn & (1 << 6)) == 0) {
                /* Table Branch.  */
                if (rn == 15) {
P
pbrook 已提交
7156 7157
                    addr = new_tmp();
                    tcg_gen_movi_i32(addr, s->pc);
P
pbrook 已提交
7158
                } else {
P
pbrook 已提交
7159
                    addr = load_reg(s, rn);
P
pbrook 已提交
7160
                }
P
pbrook 已提交
7161
                tmp = load_reg(s, rm);
P
pbrook 已提交
7162
                tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
7163 7164
                if (insn & (1 << 4)) {
                    /* tbh */
P
pbrook 已提交
7165
                    tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
7166
                    dead_tmp(tmp);
P
pbrook 已提交
7167
                    tmp = gen_ld16u(addr, IS_USER(s));
P
pbrook 已提交
7168
                } else { /* tbb */
P
pbrook 已提交
7169
                    dead_tmp(tmp);
P
pbrook 已提交
7170
                    tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
7171
                }
P
pbrook 已提交
7172 7173 7174 7175
                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 已提交
7176 7177
            } else {
                /* Load/store exclusive byte/halfword/doubleword.  */
P
pbrook 已提交
7178 7179 7180
                /* ??? These are not really atomic.  However we know
                   we never have multiple CPUs running in parallel,
                   so it is good enough.  */
P
pbrook 已提交
7181
                op = (insn >> 4) & 0x3;
7182 7183
                addr = tcg_temp_local_new();
                tcg_gen_mov_i32(addr, cpu_R[rn]);
P
pbrook 已提交
7184
                if (insn & (1 << 20)) {
P
pbrook 已提交
7185
                    gen_helper_mark_exclusive(cpu_env, addr);
P
pbrook 已提交
7186 7187
                    switch (op) {
                    case 0:
P
pbrook 已提交
7188
                        tmp = gen_ld8u(addr, IS_USER(s));
P
pbrook 已提交
7189
                        break;
B
bellard 已提交
7190
                    case 1:
P
pbrook 已提交
7191
                        tmp = gen_ld16u(addr, IS_USER(s));
B
bellard 已提交
7192
                        break;
P
pbrook 已提交
7193
                    case 3:
P
pbrook 已提交
7194 7195 7196 7197
                        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 已提交
7198 7199
                        break;
                    default:
P
pbrook 已提交
7200 7201
                        goto illegal_op;
                    }
P
pbrook 已提交
7202
                    store_reg(s, rs, tmp);
P
pbrook 已提交
7203
                } else {
P
pbrook 已提交
7204
                    int label = gen_new_label();
7205 7206 7207
                    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 已提交
7208
                    tmp = load_reg(s, rs);
P
pbrook 已提交
7209 7210
                    switch (op) {
                    case 0:
P
pbrook 已提交
7211
                        gen_st8(tmp, addr, IS_USER(s));
P
pbrook 已提交
7212 7213
                        break;
                    case 1:
P
pbrook 已提交
7214
                        gen_st16(tmp, addr, IS_USER(s));
P
pbrook 已提交
7215
                        break;
B
bellard 已提交
7216
                    case 3:
P
pbrook 已提交
7217 7218 7219 7220
                        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 已提交
7221
                        break;
P
pbrook 已提交
7222 7223
                    default:
                        goto illegal_op;
B
bellard 已提交
7224
                    }
P
pbrook 已提交
7225
                    gen_set_label(label);
7226 7227
                    tcg_gen_mov_i32(cpu_R[rm], tmp2);
                    tcg_temp_free(tmp2);
P
pbrook 已提交
7228
                }
7229
                tcg_temp_free(addr);
P
pbrook 已提交
7230 7231 7232 7233 7234
            }
        } else {
            /* Load/store multiple, RFE, SRS.  */
            if (((insn >> 23) & 1) == ((insn >> 24) & 1)) {
                /* Not available in user mode.  */
P
pbrook 已提交
7235
                if (IS_USER(s))
P
pbrook 已提交
7236 7237 7238
                    goto illegal_op;
                if (insn & (1 << 20)) {
                    /* rfe */
P
pbrook 已提交
7239 7240 7241 7242 7243 7244 7245
                    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 已提交
7246 7247
                    if (insn & (1 << 21)) {
                        /* Base writeback.  */
P
pbrook 已提交
7248 7249 7250 7251 7252 7253 7254 7255
                        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 已提交
7256
                    }
P
pbrook 已提交
7257
                    gen_rfe(s, tmp, tmp2);
P
pbrook 已提交
7258 7259 7260 7261
                } else {
                    /* srs */
                    op = (insn & 0x1f);
                    if (op == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
7262
                        addr = load_reg(s, 13);
P
pbrook 已提交
7263
                    } else {
P
pbrook 已提交
7264 7265
                        addr = new_tmp();
                        gen_helper_get_r13_banked(addr, cpu_env, tcg_const_i32(op));
P
pbrook 已提交
7266 7267
                    }
                    if ((insn & (1 << 24)) == 0) {
P
pbrook 已提交
7268
                        tcg_gen_addi_i32(addr, addr, -8);
P
pbrook 已提交
7269
                    }
P
pbrook 已提交
7270 7271 7272 7273 7274 7275
                    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 已提交
7276 7277
                    if (insn & (1 << 21)) {
                        if ((insn & (1 << 24)) == 0) {
P
pbrook 已提交
7278
                            tcg_gen_addi_i32(addr, addr, -4);
P
pbrook 已提交
7279
                        } else {
P
pbrook 已提交
7280
                            tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
7281 7282
                        }
                        if (op == (env->uncached_cpsr & CPSR_M)) {
P
pbrook 已提交
7283
                            store_reg(s, 13, addr);
P
pbrook 已提交
7284
                        } else {
P
pbrook 已提交
7285 7286
                            gen_helper_set_r13_banked(cpu_env,
                                tcg_const_i32(op), addr);
P
pbrook 已提交
7287
                        }
P
pbrook 已提交
7288 7289
                    } else {
                        dead_tmp(addr);
P
pbrook 已提交
7290 7291 7292 7293 7294
                    }
                }
            } else {
                int i;
                /* Load/store multiple.  */
P
pbrook 已提交
7295
                addr = load_reg(s, rn);
P
pbrook 已提交
7296 7297 7298 7299 7300 7301
                offset = 0;
                for (i = 0; i < 16; i++) {
                    if (insn & (1 << i))
                        offset += 4;
                }
                if (insn & (1 << 24)) {
P
pbrook 已提交
7302
                    tcg_gen_addi_i32(addr, addr, -offset);
P
pbrook 已提交
7303 7304 7305 7306 7307 7308 7309
                }

                for (i = 0; i < 16; i++) {
                    if ((insn & (1 << i)) == 0)
                        continue;
                    if (insn & (1 << 20)) {
                        /* Load.  */
P
pbrook 已提交
7310
                        tmp = gen_ld32(addr, IS_USER(s));
P
pbrook 已提交
7311
                        if (i == 15) {
P
pbrook 已提交
7312
                            gen_bx(s, tmp);
P
pbrook 已提交
7313
                        } else {
P
pbrook 已提交
7314
                            store_reg(s, i, tmp);
P
pbrook 已提交
7315 7316 7317
                        }
                    } else {
                        /* Store.  */
P
pbrook 已提交
7318 7319
                        tmp = load_reg(s, i);
                        gen_st32(tmp, addr, IS_USER(s));
P
pbrook 已提交
7320
                    }
P
pbrook 已提交
7321
                    tcg_gen_addi_i32(addr, addr, 4);
P
pbrook 已提交
7322 7323 7324 7325
                }
                if (insn & (1 << 21)) {
                    /* Base register writeback.  */
                    if (insn & (1 << 24)) {
P
pbrook 已提交
7326
                        tcg_gen_addi_i32(addr, addr, -offset);
P
pbrook 已提交
7327 7328 7329 7330
                    }
                    /* Fault if writeback register is in register list.  */
                    if (insn & (1 << rn))
                        goto illegal_op;
P
pbrook 已提交
7331 7332 7333
                    store_reg(s, rn, addr);
                } else {
                    dead_tmp(addr);
P
pbrook 已提交
7334 7335 7336 7337 7338
                }
            }
        }
        break;
    case 5: /* Data processing register constant shift.  */
7339 7340 7341 7342 7343 7344 7345
        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 已提交
7346 7347 7348 7349 7350
        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));
7351 7352
        gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
        if (gen_thumb2_data_op(s, op, conds, 0, tmp, tmp2))
P
pbrook 已提交
7353
            goto illegal_op;
7354 7355 7356 7357 7358 7359
        dead_tmp(tmp2);
        if (rd != 15) {
            store_reg(s, rd, tmp);
        } else {
            dead_tmp(tmp);
        }
P
pbrook 已提交
7360 7361 7362 7363 7364 7365 7366
        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 已提交
7367 7368
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7369 7370 7371
            if ((insn & 0x70) != 0)
                goto illegal_op;
            op = (insn >> 21) & 3;
P
pbrook 已提交
7372 7373 7374 7375
            logic_cc = (insn & (1 << 20)) != 0;
            gen_arm_shift_reg(tmp, op, tmp2, logic_cc);
            if (logic_cc)
                gen_logic_CC(tmp);
7376
            store_reg_bx(env, s, rd, tmp);
P
pbrook 已提交
7377 7378
            break;
        case 1: /* Sign/zero extend.  */
P
pbrook 已提交
7379
            tmp = load_reg(s, rm);
P
pbrook 已提交
7380 7381 7382 7383
            shift = (insn >> 4) & 3;
            /* ??? In many cases it's not neccessary to do a
               rotate, a shift is sufficient.  */
            if (shift != 0)
P
pbrook 已提交
7384
                tcg_gen_rori_i32(tmp, tmp, shift * 8);
P
pbrook 已提交
7385 7386
            op = (insn >> 20) & 7;
            switch (op) {
P
pbrook 已提交
7387 7388 7389 7390 7391 7392
            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 已提交
7393 7394 7395
            default: goto illegal_op;
            }
            if (rn != 15) {
P
pbrook 已提交
7396
                tmp2 = load_reg(s, rn);
P
pbrook 已提交
7397
                if ((op >> 1) == 1) {
P
pbrook 已提交
7398
                    gen_add16(tmp, tmp2);
P
pbrook 已提交
7399
                } else {
P
pbrook 已提交
7400 7401
                    tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7402 7403
                }
            }
P
pbrook 已提交
7404
            store_reg(s, rd, tmp);
P
pbrook 已提交
7405 7406 7407 7408 7409 7410
            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 已提交
7411 7412 7413 7414 7415
            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 已提交
7416 7417 7418 7419 7420
            break;
        case 3: /* Other data processing.  */
            op = ((insn >> 17) & 0x38) | ((insn >> 4) & 7);
            if (op < 4) {
                /* Saturating add/subtract.  */
P
pbrook 已提交
7421 7422
                tmp = load_reg(s, rn);
                tmp2 = load_reg(s, rm);
P
pbrook 已提交
7423
                if (op & 2)
P
pbrook 已提交
7424
                    gen_helper_double_saturate(tmp, tmp);
P
pbrook 已提交
7425
                if (op & 1)
P
pbrook 已提交
7426
                    gen_helper_sub_saturate(tmp, tmp2, tmp);
P
pbrook 已提交
7427
                else
P
pbrook 已提交
7428 7429
                    gen_helper_add_saturate(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7430
            } else {
P
pbrook 已提交
7431
                tmp = load_reg(s, rn);
P
pbrook 已提交
7432 7433
                switch (op) {
                case 0x0a: /* rbit */
P
pbrook 已提交
7434
                    gen_helper_rbit(tmp, tmp);
P
pbrook 已提交
7435 7436
                    break;
                case 0x08: /* rev */
A
aurel32 已提交
7437
                    tcg_gen_bswap32_i32(tmp, tmp);
P
pbrook 已提交
7438 7439
                    break;
                case 0x09: /* rev16 */
P
pbrook 已提交
7440
                    gen_rev16(tmp);
P
pbrook 已提交
7441 7442
                    break;
                case 0x0b: /* revsh */
P
pbrook 已提交
7443
                    gen_revsh(tmp);
P
pbrook 已提交
7444 7445
                    break;
                case 0x10: /* sel */
P
pbrook 已提交
7446
                    tmp2 = load_reg(s, rm);
P
pbrook 已提交
7447 7448
                    tmp3 = new_tmp();
                    tcg_gen_ld_i32(tmp3, cpu_env, offsetof(CPUState, GE));
P
pbrook 已提交
7449
                    gen_helper_sel_flags(tmp, tmp3, tmp, tmp2);
P
pbrook 已提交
7450
                    dead_tmp(tmp3);
P
pbrook 已提交
7451
                    dead_tmp(tmp2);
P
pbrook 已提交
7452 7453
                    break;
                case 0x18: /* clz */
P
pbrook 已提交
7454
                    gen_helper_clz(tmp, tmp);
P
pbrook 已提交
7455 7456 7457 7458 7459
                    break;
                default:
                    goto illegal_op;
                }
            }
P
pbrook 已提交
7460
            store_reg(s, rd, tmp);
P
pbrook 已提交
7461 7462 7463
            break;
        case 4: case 5: /* 32-bit multiply.  Sum of absolute differences.  */
            op = (insn >> 4) & 0xf;
P
pbrook 已提交
7464 7465
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7466 7467
            switch ((insn >> 20) & 7) {
            case 0: /* 32 x 32 -> 32 */
P
pbrook 已提交
7468 7469
                tcg_gen_mul_i32(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7470
                if (rs != 15) {
P
pbrook 已提交
7471
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
7472
                    if (op)
P
pbrook 已提交
7473
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
P
pbrook 已提交
7474
                    else
P
pbrook 已提交
7475 7476
                        tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7477 7478 7479
                }
                break;
            case 1: /* 16 x 16 -> 32 */
P
pbrook 已提交
7480 7481
                gen_mulxy(tmp, tmp2, op & 2, op & 1);
                dead_tmp(tmp2);
P
pbrook 已提交
7482
                if (rs != 15) {
P
pbrook 已提交
7483 7484 7485
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7486 7487 7488 7489 7490
                }
                break;
            case 2: /* Dual multiply add.  */
            case 4: /* Dual multiply subtract.  */
                if (op)
P
pbrook 已提交
7491 7492
                    gen_swap_half(tmp2);
                gen_smul_dual(tmp, tmp2);
P
pbrook 已提交
7493 7494
                /* This addition cannot overflow.  */
                if (insn & (1 << 22)) {
P
pbrook 已提交
7495
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
7496
                } else {
P
pbrook 已提交
7497
                    tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
7498
                }
P
pbrook 已提交
7499
                dead_tmp(tmp2);
P
pbrook 已提交
7500 7501
                if (rs != 15)
                  {
P
pbrook 已提交
7502 7503 7504
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7505 7506 7507 7508
                  }
                break;
            case 3: /* 32 * 16 -> 32msb */
                if (op)
P
pbrook 已提交
7509
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
P
pbrook 已提交
7510
                else
P
pbrook 已提交
7511
                    gen_sxth(tmp2);
P
pbrook 已提交
7512 7513
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
                tcg_gen_shri_i64(tmp64, tmp64, 16);
P
pbrook 已提交
7514
                tmp = new_tmp();
P
pbrook 已提交
7515
                tcg_gen_trunc_i64_i32(tmp, tmp64);
P
pbrook 已提交
7516 7517
                if (rs != 15)
                  {
P
pbrook 已提交
7518 7519 7520
                    tmp2 = load_reg(s, rs);
                    gen_helper_add_setq(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
P
pbrook 已提交
7521 7522 7523
                  }
                break;
            case 5: case 6: /* 32 * 32 -> 32msb */
P
pbrook 已提交
7524 7525 7526 7527 7528 7529 7530 7531
                gen_imull(tmp, tmp2);
                if (insn & (1 << 5)) {
                    gen_roundqd(tmp, tmp2);
                    dead_tmp(tmp2);
                } else {
                    dead_tmp(tmp);
                    tmp = tmp2;
                }
P
pbrook 已提交
7532
                if (rs != 15) {
P
pbrook 已提交
7533
                    tmp2 = load_reg(s, rs);
P
pbrook 已提交
7534
                    if (insn & (1 << 21)) {
P
pbrook 已提交
7535
                        tcg_gen_add_i32(tmp, tmp, tmp2);
B
bellard 已提交
7536
                    } else {
P
pbrook 已提交
7537
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
B
bellard 已提交
7538
                    }
P
pbrook 已提交
7539
                    dead_tmp(tmp2);
B
bellard 已提交
7540
                }
P
pbrook 已提交
7541 7542
                break;
            case 7: /* Unsigned sum of absolute differences.  */
P
pbrook 已提交
7543 7544
                gen_helper_usad8(tmp, tmp, tmp2);
                dead_tmp(tmp2);
P
pbrook 已提交
7545
                if (rs != 15) {
P
pbrook 已提交
7546 7547 7548
                    tmp2 = load_reg(s, rs);
                    tcg_gen_add_i32(tmp, tmp, tmp2);
                    dead_tmp(tmp2);
7549
                }
P
pbrook 已提交
7550
                break;
B
bellard 已提交
7551
            }
P
pbrook 已提交
7552
            store_reg(s, rd, tmp);
B
bellard 已提交
7553
            break;
P
pbrook 已提交
7554 7555
        case 6: case 7: /* 64-bit multiply, Divide.  */
            op = ((insn >> 4) & 0xf) | ((insn >> 16) & 0x70);
P
pbrook 已提交
7556 7557
            tmp = load_reg(s, rn);
            tmp2 = load_reg(s, rm);
P
pbrook 已提交
7558 7559 7560 7561 7562
            if ((op & 0x50) == 0x10) {
                /* sdiv, udiv */
                if (!arm_feature(env, ARM_FEATURE_DIV))
                    goto illegal_op;
                if (op & 0x20)
P
pbrook 已提交
7563
                    gen_helper_udiv(tmp, tmp, tmp2);
B
bellard 已提交
7564
                else
P
pbrook 已提交
7565 7566 7567
                    gen_helper_sdiv(tmp, tmp, tmp2);
                dead_tmp(tmp2);
                store_reg(s, rd, tmp);
P
pbrook 已提交
7568 7569 7570
            } else if ((op & 0xe) == 0xc) {
                /* Dual multiply accumulate long.  */
                if (op & 1)
P
pbrook 已提交
7571 7572
                    gen_swap_half(tmp2);
                gen_smul_dual(tmp, tmp2);
P
pbrook 已提交
7573
                if (op & 0x10) {
P
pbrook 已提交
7574
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
B
bellard 已提交
7575
                } else {
P
pbrook 已提交
7576
                    tcg_gen_add_i32(tmp, tmp, tmp2);
B
bellard 已提交
7577
                }
P
pbrook 已提交
7578
                dead_tmp(tmp2);
P
pbrook 已提交
7579 7580 7581 7582 7583 7584
                /* 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);
B
bellard 已提交
7585
            } else {
P
pbrook 已提交
7586 7587
                if (op & 0x20) {
                    /* Unsigned 64-bit multiply  */
P
pbrook 已提交
7588
                    tmp64 = gen_mulu_i64_i32(tmp, tmp2);
B
bellard 已提交
7589
                } else {
P
pbrook 已提交
7590 7591
                    if (op & 8) {
                        /* smlalxy */
P
pbrook 已提交
7592 7593
                        gen_mulxy(tmp, tmp2, op & 2, op & 1);
                        dead_tmp(tmp2);
P
pbrook 已提交
7594 7595
                        tmp64 = tcg_temp_new_i64();
                        tcg_gen_ext_i32_i64(tmp64, tmp);
P
pbrook 已提交
7596
                        dead_tmp(tmp);
P
pbrook 已提交
7597 7598
                    } else {
                        /* Signed 64-bit multiply  */
P
pbrook 已提交
7599
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
P
pbrook 已提交
7600
                    }
B
bellard 已提交
7601
                }
P
pbrook 已提交
7602 7603
                if (op & 4) {
                    /* umaal */
P
pbrook 已提交
7604 7605
                    gen_addq_lo(s, tmp64, rs);
                    gen_addq_lo(s, tmp64, rd);
P
pbrook 已提交
7606 7607
                } else if (op & 0x40) {
                    /* 64-bit accumulate.  */
P
pbrook 已提交
7608
                    gen_addq(s, tmp64, rs, rd);
P
pbrook 已提交
7609
                }
P
pbrook 已提交
7610
                gen_storeq_reg(s, rs, rd, tmp64);
7611
            }
B
bellard 已提交
7612
            break;
P
pbrook 已提交
7613 7614 7615 7616 7617 7618 7619 7620 7621 7622 7623 7624 7625 7626 7627 7628 7629 7630 7631 7632 7633 7634 7635 7636 7637 7638 7639 7640 7641 7642 7643 7644 7645
        }
        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.  */
7646
                    tcg_gen_movi_i32(cpu_R[14], s->pc | 1);
B
bellard 已提交
7647
                }
7648

P
pbrook 已提交
7649
                offset += s->pc;
P
pbrook 已提交
7650 7651
                if (insn & (1 << 12)) {
                    /* b/bl */
P
pbrook 已提交
7652
                    gen_jmp(s, offset);
P
pbrook 已提交
7653 7654
                } else {
                    /* blx */
P
pbrook 已提交
7655 7656
                    offset &= ~(uint32_t)2;
                    gen_bx_im(s, offset);
B
bellard 已提交
7657
                }
P
pbrook 已提交
7658 7659 7660 7661 7662 7663 7664 7665
            } 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 已提交
7666
                } else {
P
pbrook 已提交
7667 7668 7669 7670
                    op = (insn >> 20) & 7;
                    switch (op) {
                    case 0: /* msr cpsr.  */
                        if (IS_M(env)) {
P
pbrook 已提交
7671 7672 7673
                            tmp = load_reg(s, rn);
                            addr = tcg_const_i32(insn & 0xff);
                            gen_helper_v7m_msr(cpu_env, addr, tmp);
P
pbrook 已提交
7674 7675 7676 7677 7678 7679 7680
                            gen_lookup_tb(s);
                            break;
                        }
                        /* fall through */
                    case 1: /* msr spsr.  */
                        if (IS_M(env))
                            goto illegal_op;
7681 7682
                        tmp = load_reg(s, rn);
                        if (gen_set_psr(s,
P
pbrook 已提交
7683
                              msr_mask(env, s, (insn >> 8) & 0xf, op == 1),
7684
                              op == 1, tmp))
P
pbrook 已提交
7685 7686 7687 7688 7689 7690 7691 7692 7693 7694 7695 7696 7697 7698 7699 7700 7701 7702 7703 7704 7705 7706 7707 7708 7709 7710
                            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) {
7711
                            gen_set_psr_im(s, offset, 0, imm);
P
pbrook 已提交
7712 7713 7714 7715 7716 7717
                        }
                        break;
                    case 3: /* Special control operations.  */
                        op = (insn >> 4) & 0xf;
                        switch (op) {
                        case 2: /* clrex */
P
pbrook 已提交
7718
                            gen_helper_clrex(cpu_env);
P
pbrook 已提交
7719 7720 7721 7722 7723 7724 7725 7726 7727 7728 7729 7730 7731
                            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 已提交
7732 7733
                        tmp = load_reg(s, rn);
                        gen_bx(s, tmp);
P
pbrook 已提交
7734 7735 7736 7737 7738
                        break;
                    case 5: /* Exception return.  */
                        /* Unpredictable in user mode.  */
                        goto illegal_op;
                    case 6: /* mrs cpsr.  */
P
pbrook 已提交
7739
                        tmp = new_tmp();
P
pbrook 已提交
7740
                        if (IS_M(env)) {
P
pbrook 已提交
7741 7742
                            addr = tcg_const_i32(insn & 0xff);
                            gen_helper_v7m_mrs(tmp, cpu_env, addr);
P
pbrook 已提交
7743
                        } else {
P
pbrook 已提交
7744
                            gen_helper_cpsr_read(tmp);
P
pbrook 已提交
7745
                        }
P
pbrook 已提交
7746
                        store_reg(s, rd, tmp);
P
pbrook 已提交
7747 7748 7749 7750 7751
                        break;
                    case 7: /* mrs spsr.  */
                        /* Not accessible in user mode.  */
                        if (IS_USER(s) || IS_M(env))
                            goto illegal_op;
P
pbrook 已提交
7752 7753
                        tmp = load_cpu_field(spsr);
                        store_reg(s, rd, tmp);
P
pbrook 已提交
7754
                        break;
B
bellard 已提交
7755 7756
                    }
                }
P
pbrook 已提交
7757 7758 7759 7760 7761
            } else {
                /* Conditional branch.  */
                op = (insn >> 22) & 0xf;
                /* Generate a conditional jump to next instruction.  */
                s->condlabel = gen_new_label();
P
pbrook 已提交
7762
                gen_test_cc(op ^ 1, s->condlabel);
P
pbrook 已提交
7763 7764 7765 7766 7767 7768 7769 7770 7771 7772 7773 7774 7775 7776
                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 已提交
7777
                gen_jmp(s, s->pc + offset);
P
pbrook 已提交
7778 7779 7780 7781 7782 7783 7784 7785 7786 7787 7788
            }
        } 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 已提交
7789 7790 7791 7792 7793 7794
                    if (rn == 15) {
                        tmp = new_tmp();
                        tcg_gen_movi_i32(tmp, 0);
                    } else {
                        tmp = load_reg(s, rn);
                    }
P
pbrook 已提交
7795 7796 7797 7798 7799 7800
                    switch (op) {
                    case 2: /* Signed bitfield extract.  */
                        imm++;
                        if (shift + imm > 32)
                            goto illegal_op;
                        if (imm < 32)
P
pbrook 已提交
7801
                            gen_sbfx(tmp, shift, imm);
P
pbrook 已提交
7802 7803 7804 7805 7806 7807
                        break;
                    case 6: /* Unsigned bitfield extract.  */
                        imm++;
                        if (shift + imm > 32)
                            goto illegal_op;
                        if (imm < 32)
P
pbrook 已提交
7808
                            gen_ubfx(tmp, shift, (1u << imm) - 1);
P
pbrook 已提交
7809 7810 7811 7812 7813 7814
                        break;
                    case 3: /* Bitfield insert/clear.  */
                        if (imm < shift)
                            goto illegal_op;
                        imm = imm + 1 - shift;
                        if (imm != 32) {
P
pbrook 已提交
7815
                            tmp2 = load_reg(s, rd);
P
pbrook 已提交
7816
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << imm) - 1);
P
pbrook 已提交
7817
                            dead_tmp(tmp2);
P
pbrook 已提交
7818 7819 7820 7821 7822 7823 7824
                        }
                        break;
                    case 7:
                        goto illegal_op;
                    default: /* Saturate.  */
                        if (shift) {
                            if (op & 1)
P
pbrook 已提交
7825
                                tcg_gen_sari_i32(tmp, tmp, shift);
P
pbrook 已提交
7826
                            else
P
pbrook 已提交
7827
                                tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
7828
                        }
P
pbrook 已提交
7829
                        tmp2 = tcg_const_i32(imm);
P
pbrook 已提交
7830 7831 7832
                        if (op & 4) {
                            /* Unsigned.  */
                            if ((op & 1) && shift == 0)
P
pbrook 已提交
7833
                                gen_helper_usat16(tmp, tmp, tmp2);
P
pbrook 已提交
7834
                            else
P
pbrook 已提交
7835
                                gen_helper_usat(tmp, tmp, tmp2);
B
bellard 已提交
7836
                        } else {
P
pbrook 已提交
7837 7838
                            /* Signed.  */
                            if ((op & 1) && shift == 0)
P
pbrook 已提交
7839
                                gen_helper_ssat16(tmp, tmp, tmp2);
P
pbrook 已提交
7840
                            else
P
pbrook 已提交
7841
                                gen_helper_ssat(tmp, tmp, tmp2);
B
bellard 已提交
7842
                        }
P
pbrook 已提交
7843
                        break;
B
bellard 已提交
7844
                    }
P
pbrook 已提交
7845
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7846 7847 7848 7849 7850 7851 7852 7853
                } 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 已提交
7854
                            tmp = load_reg(s, rd);
P
pbrook 已提交
7855
                            tcg_gen_ext16u_i32(tmp, tmp);
P
pbrook 已提交
7856
                            tcg_gen_ori_i32(tmp, tmp, imm << 16);
B
bellard 已提交
7857
                        } else {
P
pbrook 已提交
7858
                            /* movw */
P
pbrook 已提交
7859 7860
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, imm);
B
bellard 已提交
7861 7862
                        }
                    } else {
P
pbrook 已提交
7863 7864
                        /* Add/sub 12-bit immediate.  */
                        if (rn == 15) {
P
pbrook 已提交
7865
                            offset = s->pc & ~(uint32_t)3;
P
pbrook 已提交
7866
                            if (insn & (1 << 23))
P
pbrook 已提交
7867
                                offset -= imm;
P
pbrook 已提交
7868
                            else
P
pbrook 已提交
7869
                                offset += imm;
P
pbrook 已提交
7870 7871
                            tmp = new_tmp();
                            tcg_gen_movi_i32(tmp, offset);
B
bellard 已提交
7872
                        } else {
P
pbrook 已提交
7873
                            tmp = load_reg(s, rn);
P
pbrook 已提交
7874
                            if (insn & (1 << 23))
P
pbrook 已提交
7875
                                tcg_gen_subi_i32(tmp, tmp, imm);
P
pbrook 已提交
7876
                            else
P
pbrook 已提交
7877
                                tcg_gen_addi_i32(tmp, tmp, imm);
B
bellard 已提交
7878
                        }
P
pbrook 已提交
7879
                    }
P
pbrook 已提交
7880
                    store_reg(s, rd, tmp);
P
pbrook 已提交
7881
                }
P
pbrook 已提交
7882 7883 7884 7885 7886 7887 7888 7889 7890 7891 7892 7893 7894 7895 7896 7897 7898 7899 7900 7901 7902 7903 7904 7905 7906 7907
            } 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 已提交
7908
                }
7909 7910
                tmp2 = new_tmp();
                tcg_gen_movi_i32(tmp2, imm);
P
pbrook 已提交
7911
                rn = (insn >> 16) & 0xf;
7912 7913 7914 7915 7916 7917
                if (rn == 15) {
                    tmp = new_tmp();
                    tcg_gen_movi_i32(tmp, 0);
                } else {
                    tmp = load_reg(s, rn);
                }
P
pbrook 已提交
7918 7919
                op = (insn >> 21) & 0xf;
                if (gen_thumb2_data_op(s, op, (insn & (1 << 20)) != 0,
7920
                                       shifter_out, tmp, tmp2))
P
pbrook 已提交
7921
                    goto illegal_op;
7922
                dead_tmp(tmp2);
P
pbrook 已提交
7923 7924
                rd = (insn >> 8) & 0xf;
                if (rd != 15) {
7925 7926 7927
                    store_reg(s, rd, tmp);
                } else {
                    dead_tmp(tmp);
B
bellard 已提交
7928 7929
                }
            }
P
pbrook 已提交
7930 7931 7932 7933 7934 7935
        }
        break;
    case 12: /* Load/store single data item.  */
        {
        int postinc = 0;
        int writeback = 0;
P
pbrook 已提交
7936
        int user;
P
pbrook 已提交
7937 7938
        if ((insn & 0x01100000) == 0x01000000) {
            if (disas_neon_ls_insn(env, s, insn))
7939
                goto illegal_op;
P
pbrook 已提交
7940 7941
            break;
        }
P
pbrook 已提交
7942
        user = IS_USER(s);
P
pbrook 已提交
7943
        if (rn == 15) {
P
pbrook 已提交
7944
            addr = new_tmp();
P
pbrook 已提交
7945 7946 7947 7948 7949 7950 7951
            /* 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 已提交
7952
            tcg_gen_movi_i32(addr, imm);
P
pbrook 已提交
7953
        } else {
P
pbrook 已提交
7954
            addr = load_reg(s, rn);
P
pbrook 已提交
7955 7956 7957
            if (insn & (1 << 23)) {
                /* Positive offset.  */
                imm = insn & 0xfff;
P
pbrook 已提交
7958
                tcg_gen_addi_i32(addr, addr, imm);
P
pbrook 已提交
7959 7960 7961 7962 7963 7964 7965
            } else {
                op = (insn >> 8) & 7;
                imm = insn & 0xff;
                switch (op) {
                case 0: case 8: /* Shifted Register.  */
                    shift = (insn >> 4) & 0xf;
                    if (shift > 3)
7966
                        goto illegal_op;
P
pbrook 已提交
7967
                    tmp = load_reg(s, rm);
P
pbrook 已提交
7968
                    if (shift)
P
pbrook 已提交
7969
                        tcg_gen_shli_i32(tmp, tmp, shift);
P
pbrook 已提交
7970
                    tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
7971
                    dead_tmp(tmp);
P
pbrook 已提交
7972 7973
                    break;
                case 4: /* Negative offset.  */
P
pbrook 已提交
7974
                    tcg_gen_addi_i32(addr, addr, -imm);
P
pbrook 已提交
7975 7976
                    break;
                case 6: /* User privilege.  */
P
pbrook 已提交
7977 7978
                    tcg_gen_addi_i32(addr, addr, imm);
                    user = 1;
P
pbrook 已提交
7979 7980 7981 7982 7983 7984 7985 7986 7987 7988 7989 7990
                    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 已提交
7991
                    tcg_gen_addi_i32(addr, addr, imm);
P
pbrook 已提交
7992 7993 7994
                    writeback = 1;
                    break;
                default:
B
bellard 已提交
7995
                    goto illegal_op;
P
pbrook 已提交
7996 7997 7998 7999 8000 8001 8002 8003
                }
            }
        }
        op = ((insn >> 21) & 3) | ((insn >> 22) & 4);
        if (insn & (1 << 20)) {
            /* Load.  */
            if (rs == 15 && op != 2) {
                if (op & 2)
B
bellard 已提交
8004
                    goto illegal_op;
P
pbrook 已提交
8005 8006 8007
                /* Memory hint.  Implemented as NOP.  */
            } else {
                switch (op) {
P
pbrook 已提交
8008 8009 8010 8011 8012
                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 已提交
8013 8014 8015
                default: goto illegal_op;
                }
                if (rs == 15) {
P
pbrook 已提交
8016
                    gen_bx(s, tmp);
P
pbrook 已提交
8017
                } else {
P
pbrook 已提交
8018
                    store_reg(s, rs, tmp);
P
pbrook 已提交
8019 8020 8021 8022 8023
                }
            }
        } else {
            /* Store.  */
            if (rs == 15)
B
bellard 已提交
8024
                goto illegal_op;
P
pbrook 已提交
8025
            tmp = load_reg(s, rs);
P
pbrook 已提交
8026
            switch (op) {
P
pbrook 已提交
8027 8028 8029
            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 已提交
8030
            default: goto illegal_op;
B
bellard 已提交
8031
            }
B
bellard 已提交
8032
        }
P
pbrook 已提交
8033
        if (postinc)
P
pbrook 已提交
8034 8035 8036 8037 8038 8039
            tcg_gen_addi_i32(addr, addr, imm);
        if (writeback) {
            store_reg(s, rn, addr);
        } else {
            dead_tmp(addr);
        }
P
pbrook 已提交
8040 8041 8042 8043
        }
        break;
    default:
        goto illegal_op;
B
bellard 已提交
8044
    }
P
pbrook 已提交
8045 8046 8047
    return 0;
illegal_op:
    return 1;
B
bellard 已提交
8048 8049
}

P
pbrook 已提交
8050
static void disas_thumb_insn(CPUState *env, DisasContext *s)
B
bellard 已提交
8051 8052 8053 8054
{
    uint32_t val, insn, op, rm, rn, rd, shift, cond;
    int32_t offset;
    int i;
P
pbrook 已提交
8055
    TCGv tmp;
P
pbrook 已提交
8056
    TCGv tmp2;
P
pbrook 已提交
8057
    TCGv addr;
B
bellard 已提交
8058

P
pbrook 已提交
8059 8060 8061
    if (s->condexec_mask) {
        cond = s->condexec_cond;
        s->condlabel = gen_new_label();
P
pbrook 已提交
8062
        gen_test_cc(cond ^ 1, s->condlabel);
P
pbrook 已提交
8063 8064 8065
        s->condjmp = 1;
    }

B
bellard 已提交
8066
    insn = lduw_code(s->pc);
B
bellard 已提交
8067
    s->pc += 2;
B
bellard 已提交
8068

B
bellard 已提交
8069 8070
    switch (insn >> 12) {
    case 0: case 1:
8071

B
bellard 已提交
8072 8073 8074 8075 8076
        rd = insn & 7;
        op = (insn >> 11) & 3;
        if (op == 3) {
            /* add/subtract */
            rn = (insn >> 3) & 7;
8077
            tmp = load_reg(s, rn);
B
bellard 已提交
8078 8079
            if (insn & (1 << 10)) {
                /* immediate */
8080 8081
                tmp2 = new_tmp();
                tcg_gen_movi_i32(tmp2, (insn >> 6) & 7);
B
bellard 已提交
8082 8083 8084
            } else {
                /* reg */
                rm = (insn >> 6) & 7;
8085
                tmp2 = load_reg(s, rm);
B
bellard 已提交
8086
            }
P
pbrook 已提交
8087 8088
            if (insn & (1 << 9)) {
                if (s->condexec_mask)
8089
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8090
                else
8091
                    gen_helper_sub_cc(tmp, tmp, tmp2);
P
pbrook 已提交
8092 8093
            } else {
                if (s->condexec_mask)
8094
                    tcg_gen_add_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8095
                else
8096
                    gen_helper_add_cc(tmp, tmp, tmp2);
P
pbrook 已提交
8097
            }
8098 8099
            dead_tmp(tmp2);
            store_reg(s, rd, tmp);
B
bellard 已提交
8100 8101 8102 8103
        } else {
            /* shift immediate */
            rm = (insn >> 3) & 7;
            shift = (insn >> 6) & 0x1f;
P
pbrook 已提交
8104 8105 8106 8107 8108
            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 已提交
8109 8110 8111 8112 8113 8114
        }
        break;
    case 2: case 3:
        /* arithmetic large immediate */
        op = (insn >> 11) & 3;
        rd = (insn >> 8) & 0x7;
8115 8116 8117
        if (op == 0) { /* mov */
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, insn & 0xff);
P
pbrook 已提交
8118
            if (!s->condexec_mask)
8119 8120 8121 8122 8123 8124 8125 8126 8127 8128 8129 8130 8131 8132 8133 8134 8135 8136 8137 8138 8139 8140 8141 8142 8143 8144 8145 8146 8147
                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 已提交
8148 8149 8150 8151 8152
        }
        break;
    case 4:
        if (insn & (1 << 11)) {
            rd = (insn >> 8) & 7;
B
bellard 已提交
8153 8154 8155
            /* load pc-relative.  Bit 1 of PC is ignored.  */
            val = s->pc + 2 + ((insn & 0xff) * 4);
            val &= ~(uint32_t)2;
P
pbrook 已提交
8156 8157 8158 8159 8160
            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 已提交
8161 8162 8163 8164 8165 8166 8167 8168 8169
            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 */
8170 8171 8172 8173 8174
                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 已提交
8175 8176
                break;
            case 1: /* cmp */
8177 8178 8179 8180 8181
                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 已提交
8182 8183
                break;
            case 2: /* mov/cpy */
8184 8185
                tmp = load_reg(s, rm);
                store_reg(s, rd, tmp);
B
bellard 已提交
8186 8187
                break;
            case 3:/* branch [and link] exchange thumb register */
P
pbrook 已提交
8188
                tmp = load_reg(s, rm);
B
bellard 已提交
8189 8190
                if (insn & (1 << 7)) {
                    val = (uint32_t)s->pc | 1;
P
pbrook 已提交
8191 8192 8193
                    tmp2 = new_tmp();
                    tcg_gen_movi_i32(tmp2, val);
                    store_reg(s, 14, tmp2);
B
bellard 已提交
8194
                }
P
pbrook 已提交
8195
                gen_bx(s, tmp);
B
bellard 已提交
8196 8197 8198 8199 8200 8201 8202 8203 8204 8205 8206 8207 8208 8209 8210 8211 8212 8213 8214
                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;
        }

8215 8216 8217 8218 8219 8220 8221 8222
        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 已提交
8223

8224
        tmp2 = load_reg(s, rm);
B
bellard 已提交
8225
        switch (op) {
B
bellard 已提交
8226
        case 0x0: /* and */
8227
            tcg_gen_and_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8228
            if (!s->condexec_mask)
8229
                gen_logic_CC(tmp);
B
bellard 已提交
8230 8231
            break;
        case 0x1: /* eor */
8232
            tcg_gen_xor_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8233
            if (!s->condexec_mask)
8234
                gen_logic_CC(tmp);
B
bellard 已提交
8235 8236
            break;
        case 0x2: /* lsl */
P
pbrook 已提交
8237
            if (s->condexec_mask) {
8238
                gen_helper_shl(tmp2, tmp2, tmp);
P
pbrook 已提交
8239
            } else {
8240 8241
                gen_helper_shl_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8242
            }
B
bellard 已提交
8243 8244
            break;
        case 0x3: /* lsr */
P
pbrook 已提交
8245
            if (s->condexec_mask) {
8246
                gen_helper_shr(tmp2, tmp2, tmp);
P
pbrook 已提交
8247
            } else {
8248 8249
                gen_helper_shr_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8250
            }
B
bellard 已提交
8251 8252
            break;
        case 0x4: /* asr */
P
pbrook 已提交
8253
            if (s->condexec_mask) {
8254
                gen_helper_sar(tmp2, tmp2, tmp);
P
pbrook 已提交
8255
            } else {
8256 8257
                gen_helper_sar_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8258
            }
B
bellard 已提交
8259 8260
            break;
        case 0x5: /* adc */
P
pbrook 已提交
8261
            if (s->condexec_mask)
8262
                gen_adc(tmp, tmp2);
P
pbrook 已提交
8263
            else
8264
                gen_helper_adc_cc(tmp, tmp, tmp2);
B
bellard 已提交
8265 8266
            break;
        case 0x6: /* sbc */
P
pbrook 已提交
8267
            if (s->condexec_mask)
8268
                gen_sub_carry(tmp, tmp, tmp2);
P
pbrook 已提交
8269
            else
8270
                gen_helper_sbc_cc(tmp, tmp, tmp2);
B
bellard 已提交
8271 8272
            break;
        case 0x7: /* ror */
P
pbrook 已提交
8273
            if (s->condexec_mask) {
8274
                gen_helper_ror(tmp2, tmp2, tmp);
P
pbrook 已提交
8275
            } else {
8276 8277
                gen_helper_ror_cc(tmp2, tmp2, tmp);
                gen_logic_CC(tmp2);
P
pbrook 已提交
8278
            }
B
bellard 已提交
8279 8280
            break;
        case 0x8: /* tst */
8281 8282
            tcg_gen_and_i32(tmp, tmp, tmp2);
            gen_logic_CC(tmp);
B
bellard 已提交
8283
            rd = 16;
B
bellard 已提交
8284
            break;
B
bellard 已提交
8285
        case 0x9: /* neg */
P
pbrook 已提交
8286
            if (s->condexec_mask)
8287
                tcg_gen_neg_i32(tmp, tmp2);
P
pbrook 已提交
8288
            else
8289
                gen_helper_sub_cc(tmp, tmp, tmp2);
B
bellard 已提交
8290 8291
            break;
        case 0xa: /* cmp */
8292
            gen_helper_sub_cc(tmp, tmp, tmp2);
B
bellard 已提交
8293 8294 8295
            rd = 16;
            break;
        case 0xb: /* cmn */
8296
            gen_helper_add_cc(tmp, tmp, tmp2);
B
bellard 已提交
8297 8298 8299
            rd = 16;
            break;
        case 0xc: /* orr */
8300
            tcg_gen_or_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8301
            if (!s->condexec_mask)
8302
                gen_logic_CC(tmp);
B
bellard 已提交
8303 8304
            break;
        case 0xd: /* mul */
8305
            gen_mull(tmp, tmp2);
P
pbrook 已提交
8306
            if (!s->condexec_mask)
8307
                gen_logic_CC(tmp);
B
bellard 已提交
8308 8309
            break;
        case 0xe: /* bic */
8310
            tcg_gen_bic_i32(tmp, tmp, tmp2);
P
pbrook 已提交
8311
            if (!s->condexec_mask)
8312
                gen_logic_CC(tmp);
B
bellard 已提交
8313 8314
            break;
        case 0xf: /* mvn */
8315
            tcg_gen_not_i32(tmp2, tmp2);
P
pbrook 已提交
8316
            if (!s->condexec_mask)
8317
                gen_logic_CC(tmp2);
B
bellard 已提交
8318
            val = 1;
B
bellard 已提交
8319
            rm = rd;
B
bellard 已提交
8320 8321 8322
            break;
        }
        if (rd != 16) {
8323 8324 8325 8326 8327 8328 8329 8330 8331 8332 8333
            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 已提交
8334 8335 8336 8337 8338 8339 8340 8341 8342
        }
        break;

    case 5:
        /* load/store register offset.  */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
        rm = (insn >> 6) & 7;
        op = (insn >> 9) & 7;
P
pbrook 已提交
8343
        addr = load_reg(s, rn);
P
pbrook 已提交
8344
        tmp = load_reg(s, rm);
P
pbrook 已提交
8345
        tcg_gen_add_i32(addr, addr, tmp);
P
pbrook 已提交
8346
        dead_tmp(tmp);
B
bellard 已提交
8347 8348

        if (op < 3) /* store */
P
pbrook 已提交
8349
            tmp = load_reg(s, rd);
B
bellard 已提交
8350 8351 8352

        switch (op) {
        case 0: /* str */
P
pbrook 已提交
8353
            gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8354 8355
            break;
        case 1: /* strh */
P
pbrook 已提交
8356
            gen_st16(tmp, addr, IS_USER(s));
B
bellard 已提交
8357 8358
            break;
        case 2: /* strb */
P
pbrook 已提交
8359
            gen_st8(tmp, addr, IS_USER(s));
B
bellard 已提交
8360 8361
            break;
        case 3: /* ldrsb */
P
pbrook 已提交
8362
            tmp = gen_ld8s(addr, IS_USER(s));
B
bellard 已提交
8363 8364
            break;
        case 4: /* ldr */
P
pbrook 已提交
8365
            tmp = gen_ld32(addr, IS_USER(s));
B
bellard 已提交
8366 8367
            break;
        case 5: /* ldrh */
P
pbrook 已提交
8368
            tmp = gen_ld16u(addr, IS_USER(s));
B
bellard 已提交
8369 8370
            break;
        case 6: /* ldrb */
P
pbrook 已提交
8371
            tmp = gen_ld8u(addr, IS_USER(s));
B
bellard 已提交
8372 8373
            break;
        case 7: /* ldrsh */
P
pbrook 已提交
8374
            tmp = gen_ld16s(addr, IS_USER(s));
B
bellard 已提交
8375 8376 8377
            break;
        }
        if (op >= 3) /* load */
P
pbrook 已提交
8378 8379
            store_reg(s, rd, tmp);
        dead_tmp(addr);
B
bellard 已提交
8380 8381 8382 8383 8384 8385
        break;

    case 6:
        /* load/store word immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8386
        addr = load_reg(s, rn);
B
bellard 已提交
8387
        val = (insn >> 4) & 0x7c;
P
pbrook 已提交
8388
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8389 8390 8391

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8392 8393
            tmp = gen_ld32(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8394 8395
        } else {
            /* store */
P
pbrook 已提交
8396 8397
            tmp = load_reg(s, rd);
            gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8398
        }
P
pbrook 已提交
8399
        dead_tmp(addr);
B
bellard 已提交
8400 8401 8402 8403 8404 8405
        break;

    case 7:
        /* load/store byte immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8406
        addr = load_reg(s, rn);
B
bellard 已提交
8407
        val = (insn >> 6) & 0x1f;
P
pbrook 已提交
8408
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8409 8410 8411

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8412 8413
            tmp = gen_ld8u(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8414 8415
        } else {
            /* store */
P
pbrook 已提交
8416 8417
            tmp = load_reg(s, rd);
            gen_st8(tmp, addr, IS_USER(s));
B
bellard 已提交
8418
        }
P
pbrook 已提交
8419
        dead_tmp(addr);
B
bellard 已提交
8420 8421 8422 8423 8424 8425
        break;

    case 8:
        /* load/store halfword immediate offset */
        rd = insn & 7;
        rn = (insn >> 3) & 7;
P
pbrook 已提交
8426
        addr = load_reg(s, rn);
B
bellard 已提交
8427
        val = (insn >> 5) & 0x3e;
P
pbrook 已提交
8428
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8429 8430 8431

        if (insn & (1 << 11)) {
            /* load */
P
pbrook 已提交
8432 8433
            tmp = gen_ld16u(addr, IS_USER(s));
            store_reg(s, rd, tmp);
B
bellard 已提交
8434 8435
        } else {
            /* store */
P
pbrook 已提交
8436 8437
            tmp = load_reg(s, rd);
            gen_st16(tmp, addr, IS_USER(s));
B
bellard 已提交
8438
        }
P
pbrook 已提交
8439
        dead_tmp(addr);
B
bellard 已提交
8440 8441 8442 8443 8444
        break;

    case 9:
        /* load/store from stack */
        rd = (insn >> 8) & 7;
P
pbrook 已提交
8445
        addr = load_reg(s, 13);
B
bellard 已提交
8446
        val = (insn & 0xff) * 4;
P
pbrook 已提交
8447
        tcg_gen_addi_i32(addr, addr, val);
B
bellard 已提交
8448 8449 8450

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

    case 10:
        /* add to high reg */
        rd = (insn >> 8) & 7;
B
bellard 已提交
8464 8465
        if (insn & (1 << 11)) {
            /* SP */
P
pbrook 已提交
8466
            tmp = load_reg(s, 13);
B
bellard 已提交
8467 8468
        } else {
            /* PC. bit 1 is ignored.  */
P
pbrook 已提交
8469 8470
            tmp = new_tmp();
            tcg_gen_movi_i32(tmp, (s->pc + 2) & ~(uint32_t)2);
B
bellard 已提交
8471
        }
B
bellard 已提交
8472
        val = (insn & 0xff) * 4;
P
pbrook 已提交
8473 8474
        tcg_gen_addi_i32(tmp, tmp, val);
        store_reg(s, rd, tmp);
B
bellard 已提交
8475 8476 8477 8478 8479 8480 8481 8482
        break;

    case 11:
        /* misc */
        op = (insn >> 8) & 0xf;
        switch (op) {
        case 0:
            /* adjust stack pointer */
P
pbrook 已提交
8483
            tmp = load_reg(s, 13);
B
bellard 已提交
8484 8485
            val = (insn & 0x7f) * 4;
            if (insn & (1 << 7))
B
balrog 已提交
8486
                val = -(int32_t)val;
P
pbrook 已提交
8487 8488
            tcg_gen_addi_i32(tmp, tmp, val);
            store_reg(s, 13, tmp);
B
bellard 已提交
8489 8490
            break;

P
pbrook 已提交
8491 8492 8493 8494
        case 2: /* sign/zero extend.  */
            ARCH(6);
            rd = insn & 7;
            rm = (insn >> 3) & 7;
P
pbrook 已提交
8495
            tmp = load_reg(s, rm);
P
pbrook 已提交
8496
            switch ((insn >> 6) & 3) {
P
pbrook 已提交
8497 8498 8499 8500
            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 已提交
8501
            }
P
pbrook 已提交
8502
            store_reg(s, rd, tmp);
P
pbrook 已提交
8503
            break;
B
bellard 已提交
8504 8505
        case 4: case 5: case 0xc: case 0xd:
            /* push/pop */
P
pbrook 已提交
8506
            addr = load_reg(s, 13);
B
bellard 已提交
8507 8508
            if (insn & (1 << 8))
                offset = 4;
B
bellard 已提交
8509
            else
B
bellard 已提交
8510 8511 8512 8513 8514 8515
                offset = 0;
            for (i = 0; i < 8; i++) {
                if (insn & (1 << i))
                    offset += 4;
            }
            if ((insn & (1 << 11)) == 0) {
P
pbrook 已提交
8516
                tcg_gen_addi_i32(addr, addr, -offset);
B
bellard 已提交
8517
            }
B
bellard 已提交
8518 8519 8520 8521
            for (i = 0; i < 8; i++) {
                if (insn & (1 << i)) {
                    if (insn & (1 << 11)) {
                        /* pop */
P
pbrook 已提交
8522 8523
                        tmp = gen_ld32(addr, IS_USER(s));
                        store_reg(s, i, tmp);
B
bellard 已提交
8524 8525
                    } else {
                        /* push */
P
pbrook 已提交
8526 8527
                        tmp = load_reg(s, i);
                        gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8528
                    }
B
bellard 已提交
8529
                    /* advance to the next address.  */
P
pbrook 已提交
8530
                    tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8531 8532
                }
            }
P
pbrook 已提交
8533
            TCGV_UNUSED(tmp);
B
bellard 已提交
8534 8535 8536
            if (insn & (1 << 8)) {
                if (insn & (1 << 11)) {
                    /* pop pc */
P
pbrook 已提交
8537
                    tmp = gen_ld32(addr, IS_USER(s));
B
bellard 已提交
8538 8539 8540 8541
                    /* don't set the pc until the rest of the instruction
                       has completed */
                } else {
                    /* push lr */
P
pbrook 已提交
8542 8543
                    tmp = load_reg(s, 14);
                    gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8544
                }
P
pbrook 已提交
8545
                tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8546
            }
B
bellard 已提交
8547
            if ((insn & (1 << 11)) == 0) {
P
pbrook 已提交
8548
                tcg_gen_addi_i32(addr, addr, -offset);
B
bellard 已提交
8549
            }
B
bellard 已提交
8550
            /* write back the new stack pointer */
P
pbrook 已提交
8551
            store_reg(s, 13, addr);
B
bellard 已提交
8552 8553
            /* set the new PC value */
            if ((insn & 0x0900) == 0x0900)
P
pbrook 已提交
8554
                gen_bx(s, tmp);
B
bellard 已提交
8555 8556
            break;

P
pbrook 已提交
8557 8558
        case 1: case 3: case 9: case 11: /* czb */
            rm = insn & 7;
P
pbrook 已提交
8559
            tmp = load_reg(s, rm);
P
pbrook 已提交
8560 8561 8562
            s->condlabel = gen_new_label();
            s->condjmp = 1;
            if (insn & (1 << 11))
P
pbrook 已提交
8563
                tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, s->condlabel);
P
pbrook 已提交
8564
            else
P
pbrook 已提交
8565
                tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, s->condlabel);
P
pbrook 已提交
8566
            dead_tmp(tmp);
P
pbrook 已提交
8567 8568 8569 8570 8571 8572 8573 8574 8575 8576 8577 8578 8579 8580 8581 8582 8583
            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 已提交
8584
        case 0xe: /* bkpt */
P
pbrook 已提交
8585
            gen_set_condexec(s);
P
pbrook 已提交
8586
            gen_set_pc_im(s->pc - 2);
P
pbrook 已提交
8587
            gen_exception(EXCP_BKPT);
P
pbrook 已提交
8588 8589 8590
            s->is_jmp = DISAS_JUMP;
            break;

P
pbrook 已提交
8591 8592 8593 8594
        case 0xa: /* rev */
            ARCH(6);
            rn = (insn >> 3) & 0x7;
            rd = insn & 0x7;
P
pbrook 已提交
8595
            tmp = load_reg(s, rn);
P
pbrook 已提交
8596
            switch ((insn >> 6) & 3) {
A
aurel32 已提交
8597
            case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
P
pbrook 已提交
8598 8599
            case 1: gen_rev16(tmp); break;
            case 3: gen_revsh(tmp); break;
P
pbrook 已提交
8600 8601
            default: goto illegal_op;
            }
P
pbrook 已提交
8602
            store_reg(s, rd, tmp);
P
pbrook 已提交
8603 8604 8605 8606 8607 8608 8609
            break;

        case 6: /* cps */
            ARCH(6);
            if (IS_USER(s))
                break;
            if (IS_M(env)) {
P
pbrook 已提交
8610
                tmp = tcg_const_i32((insn & (1 << 4)) != 0);
P
pbrook 已提交
8611
                /* PRIMASK */
P
pbrook 已提交
8612 8613 8614 8615
                if (insn & 1) {
                    addr = tcg_const_i32(16);
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
                }
P
pbrook 已提交
8616
                /* FAULTMASK */
P
pbrook 已提交
8617 8618 8619 8620
                if (insn & 2) {
                    addr = tcg_const_i32(17);
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
                }
P
pbrook 已提交
8621 8622 8623 8624 8625 8626
                gen_lookup_tb(s);
            } else {
                if (insn & (1 << 4))
                    shift = CPSR_A | CPSR_I | CPSR_F;
                else
                    shift = 0;
8627
                gen_set_psr_im(s, shift, 0, ((insn & 7) << 6) & shift);
P
pbrook 已提交
8628 8629 8630
            }
            break;

B
bellard 已提交
8631 8632 8633 8634 8635 8636 8637 8638
        default:
            goto undef;
        }
        break;

    case 12:
        /* load/store multiple */
        rn = (insn >> 8) & 0x7;
P
pbrook 已提交
8639
        addr = load_reg(s, rn);
B
bellard 已提交
8640 8641 8642 8643
        for (i = 0; i < 8; i++) {
            if (insn & (1 << i)) {
                if (insn & (1 << 11)) {
                    /* load */
P
pbrook 已提交
8644 8645
                    tmp = gen_ld32(addr, IS_USER(s));
                    store_reg(s, i, tmp);
B
bellard 已提交
8646 8647
                } else {
                    /* store */
P
pbrook 已提交
8648 8649
                    tmp = load_reg(s, i);
                    gen_st32(tmp, addr, IS_USER(s));
B
bellard 已提交
8650
                }
B
bellard 已提交
8651
                /* advance to the next address */
P
pbrook 已提交
8652
                tcg_gen_addi_i32(addr, addr, 4);
B
bellard 已提交
8653 8654
            }
        }
B
bellard 已提交
8655
        /* Base register writeback.  */
P
pbrook 已提交
8656 8657 8658 8659 8660
        if ((insn & (1 << rn)) == 0) {
            store_reg(s, rn, addr);
        } else {
            dead_tmp(addr);
        }
B
bellard 已提交
8661 8662 8663 8664 8665 8666 8667 8668 8669 8670
        break;

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

        if (cond == 0xf) {
            /* swi */
P
pbrook 已提交
8671
            gen_set_condexec(s);
8672
            gen_set_pc_im(s->pc);
P
pbrook 已提交
8673
            s->is_jmp = DISAS_SWI;
B
bellard 已提交
8674 8675 8676
            break;
        }
        /* generate a conditional jump to next instruction */
8677
        s->condlabel = gen_new_label();
P
pbrook 已提交
8678
        gen_test_cc(cond ^ 1, s->condlabel);
8679
        s->condjmp = 1;
B
bellard 已提交
8680 8681

        /* jump to the offset */
B
bellard 已提交
8682
        val = (uint32_t)s->pc + 2;
B
bellard 已提交
8683
        offset = ((int32_t)insn << 24) >> 24;
B
bellard 已提交
8684
        val += offset << 1;
B
bellard 已提交
8685
        gen_jmp(s, val);
B
bellard 已提交
8686 8687 8688
        break;

    case 14:
P
pbrook 已提交
8689
        if (insn & (1 << 11)) {
P
pbrook 已提交
8690 8691
            if (disas_thumb2_insn(env, s, insn))
              goto undef32;
P
pbrook 已提交
8692 8693
            break;
        }
P
pbrook 已提交
8694
        /* unconditional branch */
B
bellard 已提交
8695 8696 8697
        val = (uint32_t)s->pc;
        offset = ((int32_t)insn << 21) >> 21;
        val += (offset << 1) + 2;
B
bellard 已提交
8698
        gen_jmp(s, val);
B
bellard 已提交
8699 8700 8701
        break;

    case 15:
P
pbrook 已提交
8702
        if (disas_thumb2_insn(env, s, insn))
B
balrog 已提交
8703
            goto undef32;
P
pbrook 已提交
8704
        break;
B
bellard 已提交
8705 8706
    }
    return;
P
pbrook 已提交
8707 8708
undef32:
    gen_set_condexec(s);
P
pbrook 已提交
8709
    gen_set_pc_im(s->pc - 4);
P
pbrook 已提交
8710
    gen_exception(EXCP_UDEF);
P
pbrook 已提交
8711 8712 8713
    s->is_jmp = DISAS_JUMP;
    return;
illegal_op:
B
bellard 已提交
8714
undef:
P
pbrook 已提交
8715
    gen_set_condexec(s);
P
pbrook 已提交
8716
    gen_set_pc_im(s->pc - 2);
P
pbrook 已提交
8717
    gen_exception(EXCP_UDEF);
B
bellard 已提交
8718 8719 8720
    s->is_jmp = DISAS_JUMP;
}

B
bellard 已提交
8721 8722 8723
/* 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. */
8724 8725 8726
static inline void gen_intermediate_code_internal(CPUState *env,
                                                  TranslationBlock *tb,
                                                  int search_pc)
B
bellard 已提交
8727 8728
{
    DisasContext dc1, *dc = &dc1;
8729
    CPUBreakpoint *bp;
B
bellard 已提交
8730 8731
    uint16_t *gen_opc_end;
    int j, lj;
B
bellard 已提交
8732
    target_ulong pc_start;
B
bellard 已提交
8733
    uint32_t next_page_start;
P
pbrook 已提交
8734 8735
    int num_insns;
    int max_insns;
8736

B
bellard 已提交
8737
    /* generate intermediate code */
P
pbrook 已提交
8738 8739
    num_temps = 0;

B
bellard 已提交
8740
    pc_start = tb->pc;
8741

B
bellard 已提交
8742 8743 8744 8745 8746 8747
    dc->tb = tb;

    gen_opc_end = gen_opc_buf + OPC_MAX_SIZE;

    dc->is_jmp = DISAS_NEXT;
    dc->pc = pc_start;
B
bellard 已提交
8748
    dc->singlestep_enabled = env->singlestep_enabled;
8749
    dc->condjmp = 0;
B
bellard 已提交
8750
    dc->thumb = env->thumb;
P
pbrook 已提交
8751 8752
    dc->condexec_mask = (env->condexec_bits & 0xf) << 1;
    dc->condexec_cond = env->condexec_bits >> 4;
B
bellard 已提交
8753
#if !defined(CONFIG_USER_ONLY)
P
pbrook 已提交
8754 8755 8756 8757 8758
    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 已提交
8759
#endif
P
pbrook 已提交
8760 8761 8762 8763
    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 已提交
8764 8765
    cpu_V0 = cpu_F0d;
    cpu_V1 = cpu_F1d;
P
pbrook 已提交
8766
    /* FIXME: cpu_M0 can probably be the same as cpu_V0.  */
P
pbrook 已提交
8767
    cpu_M0 = tcg_temp_new_i64();
B
bellard 已提交
8768
    next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
B
bellard 已提交
8769
    lj = -1;
P
pbrook 已提交
8770 8771 8772 8773 8774 8775
    num_insns = 0;
    max_insns = tb->cflags & CF_COUNT_MASK;
    if (max_insns == 0)
        max_insns = CF_COUNT_MASK;

    gen_icount_start();
P
pbrook 已提交
8776 8777 8778
    /* 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 已提交
8779 8780 8781
      {
        TCGv tmp = new_tmp();
        tcg_gen_movi_i32(tmp, 0);
P
pbrook 已提交
8782
        store_cpu_field(tmp, condexec_bits);
P
pbrook 已提交
8783
      }
B
bellard 已提交
8784
    do {
8785 8786 8787 8788 8789 8790 8791 8792 8793 8794
#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 已提交
8795 8796 8797
        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 已提交
8798
            gen_exception(EXCP_EXCEPTION_EXIT);
8799 8800
            dc->is_jmp = DISAS_UPDATE;
            break;
P
pbrook 已提交
8801 8802 8803
        }
#endif

B
Blue Swirl 已提交
8804 8805
        if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
            QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
8806
                if (bp->pc == dc->pc) {
P
pbrook 已提交
8807
                    gen_set_condexec(dc);
P
pbrook 已提交
8808
                    gen_set_pc_im(dc->pc);
P
pbrook 已提交
8809
                    gen_exception(EXCP_DEBUG);
B
bellard 已提交
8810
                    dc->is_jmp = DISAS_JUMP;
P
pbrook 已提交
8811 8812 8813 8814
                    /* Advance PC so that clearing the breakpoint will
                       invalidate this TB.  */
                    dc->pc += 2;
                    goto done_generating;
B
bellard 已提交
8815 8816 8817 8818
                    break;
                }
            }
        }
B
bellard 已提交
8819 8820 8821 8822 8823 8824 8825
        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 已提交
8826
            gen_opc_pc[lj] = dc->pc;
B
bellard 已提交
8827
            gen_opc_instr_start[lj] = 1;
P
pbrook 已提交
8828
            gen_opc_icount[lj] = num_insns;
B
bellard 已提交
8829
        }
8830

P
pbrook 已提交
8831 8832 8833
        if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO))
            gen_io_start();

P
pbrook 已提交
8834 8835 8836 8837 8838 8839 8840 8841 8842 8843 8844 8845 8846
        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 已提交
8847 8848 8849 8850
        if (num_temps) {
            fprintf(stderr, "Internal resource leak before %08x\n", dc->pc);
            num_temps = 0;
        }
8851 8852 8853 8854 8855

        if (dc->condjmp && !dc->is_jmp) {
            gen_set_label(dc->condlabel);
            dc->condjmp = 0;
        }
B
balrog 已提交
8856
        /* Translation stops when a conditional branch is encountered.
8857
         * Otherwise the subsequent code could get translated several times.
B
bellard 已提交
8858
         * Also stop translation when a page boundary is reached.  This
T
ths 已提交
8859
         * ensures prefetch aborts occur at the right place.  */
P
pbrook 已提交
8860
        num_insns ++;
B
bellard 已提交
8861 8862
    } while (!dc->is_jmp && gen_opc_ptr < gen_opc_end &&
             !env->singlestep_enabled &&
8863
             !singlestep &&
P
pbrook 已提交
8864 8865 8866 8867 8868 8869 8870 8871 8872 8873 8874
             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 已提交
8875

B
bellard 已提交
8876
    /* At this stage dc->condjmp will only be set when the skipped
P
pbrook 已提交
8877 8878
       instruction was a conditional branch or trap, and the PC has
       already been written.  */
8879
    if (unlikely(env->singlestep_enabled)) {
B
bellard 已提交
8880
        /* Make sure the pc is updated, and raise a debug exception.  */
8881
        if (dc->condjmp) {
P
pbrook 已提交
8882 8883
            gen_set_condexec(dc);
            if (dc->is_jmp == DISAS_SWI) {
P
pbrook 已提交
8884
                gen_exception(EXCP_SWI);
P
pbrook 已提交
8885
            } else {
P
pbrook 已提交
8886
                gen_exception(EXCP_DEBUG);
P
pbrook 已提交
8887
            }
8888 8889 8890
            gen_set_label(dc->condlabel);
        }
        if (dc->condjmp || !dc->is_jmp) {
P
pbrook 已提交
8891
            gen_set_pc_im(dc->pc);
8892
            dc->condjmp = 0;
B
bellard 已提交
8893
        }
P
pbrook 已提交
8894 8895
        gen_set_condexec(dc);
        if (dc->is_jmp == DISAS_SWI && !dc->condjmp) {
P
pbrook 已提交
8896
            gen_exception(EXCP_SWI);
P
pbrook 已提交
8897 8898 8899
        } else {
            /* FIXME: Single stepping a WFI insn will not halt
               the CPU.  */
P
pbrook 已提交
8900
            gen_exception(EXCP_DEBUG);
P
pbrook 已提交
8901
        }
B
bellard 已提交
8902
    } else {
P
pbrook 已提交
8903 8904 8905 8906 8907 8908 8909 8910 8911
        /* 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 已提交
8912 8913
        switch(dc->is_jmp) {
        case DISAS_NEXT:
8914
            gen_goto_tb(dc, 1, dc->pc);
B
bellard 已提交
8915 8916 8917 8918 8919
            break;
        default:
        case DISAS_JUMP:
        case DISAS_UPDATE:
            /* indicate that the hash table must be used to find the next TB */
B
bellard 已提交
8920
            tcg_gen_exit_tb(0);
B
bellard 已提交
8921 8922 8923 8924
            break;
        case DISAS_TB_JUMP:
            /* nothing more to generate */
            break;
P
pbrook 已提交
8925
        case DISAS_WFI:
P
pbrook 已提交
8926
            gen_helper_wfi();
P
pbrook 已提交
8927 8928
            break;
        case DISAS_SWI:
P
pbrook 已提交
8929
            gen_exception(EXCP_SWI);
P
pbrook 已提交
8930
            break;
B
bellard 已提交
8931
        }
8932 8933
        if (dc->condjmp) {
            gen_set_label(dc->condlabel);
P
pbrook 已提交
8934
            gen_set_condexec(dc);
8935
            gen_goto_tb(dc, 1, dc->pc);
8936 8937
            dc->condjmp = 0;
        }
B
bellard 已提交
8938
    }
P
pbrook 已提交
8939

P
pbrook 已提交
8940
done_generating:
P
pbrook 已提交
8941
    gen_icount_end(tb, num_insns);
B
bellard 已提交
8942 8943 8944
    *gen_opc_ptr = INDEX_op_end;

#ifdef DEBUG_DISAS
8945
    if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
8946 8947 8948 8949
        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 已提交
8950 8951
    }
#endif
B
bellard 已提交
8952 8953 8954 8955 8956 8957
    if (search_pc) {
        j = gen_opc_ptr - gen_opc_buf;
        lj++;
        while (lj <= j)
            gen_opc_instr_start[lj++] = 0;
    } else {
B
bellard 已提交
8958
        tb->size = dc->pc - pc_start;
P
pbrook 已提交
8959
        tb->icount = num_insns;
B
bellard 已提交
8960
    }
B
bellard 已提交
8961 8962
}

8963
void gen_intermediate_code(CPUState *env, TranslationBlock *tb)
B
bellard 已提交
8964
{
8965
    gen_intermediate_code_internal(env, tb, 0);
B
bellard 已提交
8966 8967
}

8968
void gen_intermediate_code_pc(CPUState *env, TranslationBlock *tb)
B
bellard 已提交
8969
{
8970
    gen_intermediate_code_internal(env, tb, 1);
B
bellard 已提交
8971 8972
}

B
bellard 已提交
8973 8974 8975 8976
static const char *cpu_mode_names[16] = {
  "usr", "fiq", "irq", "svc", "???", "???", "???", "abt",
  "???", "???", "???", "und", "???", "???", "???", "sys"
};
P
pbrook 已提交
8977

8978
void cpu_dump_state(CPUState *env, FILE *f,
B
bellard 已提交
8979 8980
                    int (*cpu_fprintf)(FILE *f, const char *fmt, ...),
                    int flags)
B
bellard 已提交
8981 8982
{
    int i;
T
ths 已提交
8983
#if 0
B
bellard 已提交
8984
    union {
B
bellard 已提交
8985 8986 8987 8988
        uint32_t i;
        float s;
    } s0, s1;
    CPU_DoubleU d;
P
pbrook 已提交
8989 8990 8991 8992 8993 8994
    /* ??? This assumes float64 and double have the same layout.
       Oh well, it's only debug dumps.  */
    union {
        float64 f64;
        double d;
    } d0;
T
ths 已提交
8995
#endif
B
bellard 已提交
8996
    uint32_t psr;
B
bellard 已提交
8997 8998

    for(i=0;i<16;i++) {
B
bellard 已提交
8999
        cpu_fprintf(f, "R%02d=%08x", i, env->regs[i]);
B
bellard 已提交
9000
        if ((i % 4) == 3)
B
bellard 已提交
9001
            cpu_fprintf(f, "\n");
B
bellard 已提交
9002
        else
B
bellard 已提交
9003
            cpu_fprintf(f, " ");
B
bellard 已提交
9004
    }
B
bellard 已提交
9005
    psr = cpsr_read(env);
9006 9007
    cpu_fprintf(f, "PSR=%08x %c%c%c%c %c %s%d\n",
                psr,
B
bellard 已提交
9008 9009 9010 9011
                psr & (1 << 31) ? 'N' : '-',
                psr & (1 << 30) ? 'Z' : '-',
                psr & (1 << 29) ? 'C' : '-',
                psr & (1 << 28) ? 'V' : '-',
9012
                psr & CPSR_T ? 'T' : 'A',
B
bellard 已提交
9013
                cpu_mode_names[psr & 0xf], (psr & 0x10) ? 32 : 26);
B
bellard 已提交
9014

P
pbrook 已提交
9015
#if 0
B
bellard 已提交
9016
    for (i = 0; i < 16; i++) {
B
bellard 已提交
9017 9018 9019
        d.d = env->vfp.regs[i];
        s0.i = d.l.lower;
        s1.i = d.l.upper;
P
pbrook 已提交
9020 9021
        d0.f64 = d.d;
        cpu_fprintf(f, "s%02d=%08x(%8g) s%02d=%08x(%8g) d%02d=%08x%08x(%8g)\n",
B
bellard 已提交
9022
                    i * 2, (int)s0.i, s0.s,
P
pbrook 已提交
9023
                    i * 2 + 1, (int)s1.i, s1.s,
B
bellard 已提交
9024
                    i, (int)(uint32_t)d.l.upper, (int)(uint32_t)d.l.lower,
P
pbrook 已提交
9025
                    d0.d);
B
bellard 已提交
9026
    }
P
pbrook 已提交
9027
    cpu_fprintf(f, "FPSCR: %08x\n", (int)env->vfp.xregs[ARM_VFP_FPSCR]);
P
pbrook 已提交
9028
#endif
B
bellard 已提交
9029
}
B
bellard 已提交
9030

A
aurel32 已提交
9031 9032 9033 9034 9035
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];
}