tcg-target.inc.c 71.6 KB
Newer Older
B
balrog 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * Tiny Code Generator for QEMU
 *
 * Copyright (c) 2008 Andrzej Zaborowski
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
24

R
Richard Henderson 已提交
25
#include "elf.h"
R
Richard Henderson 已提交
26 27
#include "tcg-be-ldst.h"

28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
/* The __ARM_ARCH define is provided by gcc 4.8.  Construct it otherwise.  */
#ifndef __ARM_ARCH
# if defined(__ARM_ARCH_7__) || defined(__ARM_ARCH_7A__) \
     || defined(__ARM_ARCH_7R__) || defined(__ARM_ARCH_7M__) \
     || defined(__ARM_ARCH_7EM__)
#  define __ARM_ARCH 7
# elif defined(__ARM_ARCH_6__) || defined(__ARM_ARCH_6J__) \
       || defined(__ARM_ARCH_6Z__) || defined(__ARM_ARCH_6ZK__) \
       || defined(__ARM_ARCH_6K__) || defined(__ARM_ARCH_6T2__)
#  define __ARM_ARCH 6
# elif defined(__ARM_ARCH_5__) || defined(__ARM_ARCH_5E__) \
       || defined(__ARM_ARCH_5T__) || defined(__ARM_ARCH_5TE__) \
       || defined(__ARM_ARCH_5TEJ__)
#  define __ARM_ARCH 5
# else
#  define __ARM_ARCH 4
# endif
#endif

47 48
static int arm_arch = __ARM_ARCH;

49 50 51
#if defined(__ARM_ARCH_5T__) \
    || defined(__ARM_ARCH_5TE__) || defined(__ARM_ARCH_5TEJ__)
# define use_armv5t_instructions 1
52
#else
53
# define use_armv5t_instructions use_armv6_instructions
54 55
#endif

56 57
#define use_armv6_instructions  (__ARM_ARCH >= 6 || arm_arch >= 6)
#define use_armv7_instructions  (__ARM_ARCH >= 7 || arm_arch >= 7)
58

59 60 61 62
#ifndef use_idiv_instructions
bool use_idiv_instructions;
#endif

63 64 65 66 67 68 69
/* ??? Ought to think about changing CONFIG_SOFTMMU to always defined.  */
#ifdef CONFIG_SOFTMMU
# define USING_SOFTMMU 1
#else
# define USING_SOFTMMU 0
#endif

70
#ifdef CONFIG_DEBUG_TCG
71
static const char * const tcg_target_reg_names[TCG_TARGET_NB_REGS] = {
B
balrog 已提交
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86
    "%r0",
    "%r1",
    "%r2",
    "%r3",
    "%r4",
    "%r5",
    "%r6",
    "%r7",
    "%r8",
    "%r9",
    "%r10",
    "%r11",
    "%r12",
    "%r13",
    "%r14",
87
    "%pc",
B
balrog 已提交
88
};
89
#endif
B
balrog 已提交
90

91
static const int tcg_target_reg_alloc_order[] = {
B
balrog 已提交
92 93 94 95 96 97 98 99 100
    TCG_REG_R4,
    TCG_REG_R5,
    TCG_REG_R6,
    TCG_REG_R7,
    TCG_REG_R8,
    TCG_REG_R9,
    TCG_REG_R10,
    TCG_REG_R11,
    TCG_REG_R13,
101 102 103 104 105
    TCG_REG_R0,
    TCG_REG_R1,
    TCG_REG_R2,
    TCG_REG_R3,
    TCG_REG_R12,
B
balrog 已提交
106 107 108
    TCG_REG_R14,
};

109
static const int tcg_target_call_iarg_regs[4] = {
B
balrog 已提交
110 111
    TCG_REG_R0, TCG_REG_R1, TCG_REG_R2, TCG_REG_R3
};
112
static const int tcg_target_call_oarg_regs[2] = {
B
balrog 已提交
113 114 115
    TCG_REG_R0, TCG_REG_R1
};

116
#define TCG_REG_TMP  TCG_REG_R12
117

118
static inline void reloc_pc24(tcg_insn_unit *code_ptr, tcg_insn_unit *target)
119
{
120 121
    ptrdiff_t offset = (tcg_ptr_byte_diff(target, code_ptr) - 8) >> 2;
    *code_ptr = (*code_ptr & ~0xffffff) | (offset & 0xffffff);
122 123
}

124 125 126 127 128 129 130 131
static inline void reloc_pc24_atomic(tcg_insn_unit *code_ptr, tcg_insn_unit *target)
{
    ptrdiff_t offset = (tcg_ptr_byte_diff(target, code_ptr) - 8) >> 2;
    tcg_insn_unit insn = atomic_read(code_ptr);
    tcg_debug_assert(offset == sextract32(offset, 0, 24));
    atomic_set(code_ptr, deposit32(insn, 0, 24, offset));
}

132
static void patch_reloc(tcg_insn_unit *code_ptr, int type,
133
                        intptr_t value, intptr_t addend)
B
balrog 已提交
134
{
135 136
    tcg_debug_assert(type == R_ARM_PC24);
    tcg_debug_assert(addend == 0);
137
    reloc_pc24(code_ptr, (tcg_insn_unit *)value);
B
balrog 已提交
138 139
}

140 141 142 143
#define TCG_CT_CONST_ARM  0x100
#define TCG_CT_CONST_INV  0x200
#define TCG_CT_CONST_NEG  0x400
#define TCG_CT_CONST_ZERO 0x800
144

B
balrog 已提交
145
/* parse target specific constraints */
146
static int target_parse_constraint(TCGArgConstraint *ct, const char **pct_str)
B
balrog 已提交
147 148 149 150 151
{
    const char *ct_str;

    ct_str = *pct_str;
    switch (ct_str[0]) {
152
    case 'I':
153 154 155 156 157
        ct->ct |= TCG_CT_CONST_ARM;
        break;
    case 'K':
        ct->ct |= TCG_CT_CONST_INV;
        break;
158 159 160
    case 'N': /* The gcc constraint letter is L, already used here.  */
        ct->ct |= TCG_CT_CONST_NEG;
        break;
161 162 163
    case 'Z':
        ct->ct |= TCG_CT_CONST_ZERO;
        break;
164

B
balrog 已提交
165 166 167 168 169
    case 'r':
        ct->ct |= TCG_CT_REG;
        tcg_regset_set32(ct->u.regs, 0, (1 << TCG_TARGET_NB_REGS) - 1);
        break;

170 171
    /* qemu_ld address */
    case 'l':
B
balrog 已提交
172 173
        ct->ct |= TCG_CT_REG;
        tcg_regset_set32(ct->u.regs, 0, (1 << TCG_TARGET_NB_REGS) - 1);
174
#ifdef CONFIG_SOFTMMU
175
        /* r0-r2,lr will be overwritten when reading the tlb entry,
176
           so don't use these. */
B
balrog 已提交
177 178
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R0);
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R1);
179
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R2);
180
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R14);
181
#endif
182 183
        break;

184
    /* qemu_st address & data */
185
    case 's':
B
balrog 已提交
186 187
        ct->ct |= TCG_CT_REG;
        tcg_regset_set32(ct->u.regs, 0, (1 << TCG_TARGET_NB_REGS) - 1);
188 189
        /* r0-r2 will be overwritten when reading the tlb entry (softmmu only)
           and r0-r1 doing the byte swapping, so don't use these. */
B
balrog 已提交
190 191
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R0);
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R1);
192 193
#if defined(CONFIG_SOFTMMU)
        /* Avoid clashes with registers being used for helper args */
194
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R2);
195
#if TARGET_LONG_BITS == 64
196 197 198
        /* Avoid clashes with registers being used for helper args */
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R3);
#endif
199
        tcg_regset_reset_reg(ct->u.regs, TCG_REG_R14);
B
balrog 已提交
200
#endif
201
        break;
B
balrog 已提交
202 203 204 205 206 207 208 209 210 211

    default:
        return -1;
    }
    ct_str++;
    *pct_str = ct_str;

    return 0;
}

212 213 214 215 216 217 218 219 220
static inline uint32_t rotl(uint32_t val, int n)
{
  return (val << n) | (val >> (32 - n));
}

/* ARM immediates for ALU instructions are made of an unsigned 8-bit
   right-rotated by an even amount between 0 and 30. */
static inline int encode_imm(uint32_t imm)
{
L
Laurent Desnogues 已提交
221 222
    int shift;

223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
    /* simple case, only lower bits */
    if ((imm & ~0xff) == 0)
        return 0;
    /* then try a simple even shift */
    shift = ctz32(imm) & ~1;
    if (((imm >> shift) & ~0xff) == 0)
        return 32 - shift;
    /* now try harder with rotations */
    if ((rotl(imm, 2) & ~0xff) == 0)
        return 2;
    if ((rotl(imm, 4) & ~0xff) == 0)
        return 4;
    if ((rotl(imm, 6) & ~0xff) == 0)
        return 6;
    /* imm can't be encoded */
    return -1;
}
240 241 242

static inline int check_fit_imm(uint32_t imm)
{
243
    return encode_imm(imm) >= 0;
244 245
}

B
balrog 已提交
246 247 248 249 250 251 252 253
/* Test if a constant matches the constraint.
 * TODO: define constraints for:
 *
 * ldr/str offset:   between -0xfff and 0xfff
 * ldrh/strh offset: between -0xff and 0xff
 * mov operand2:     values represented with x << (2 * y), x < 0x100
 * add, sub, eor...: ditto
 */
254
static inline int tcg_target_const_match(tcg_target_long val, TCGType type,
255
                                         const TCGArgConstraint *arg_ct)
B
balrog 已提交
256 257 258
{
    int ct;
    ct = arg_ct->ct;
259
    if (ct & TCG_CT_CONST) {
B
balrog 已提交
260
        return 1;
261
    } else if ((ct & TCG_CT_CONST_ARM) && check_fit_imm(val)) {
262
        return 1;
263 264
    } else if ((ct & TCG_CT_CONST_INV) && check_fit_imm(~val)) {
        return 1;
265 266
    } else if ((ct & TCG_CT_CONST_NEG) && check_fit_imm(-val)) {
        return 1;
267 268
    } else if ((ct & TCG_CT_CONST_ZERO) && val == 0) {
        return 1;
269
    } else {
B
balrog 已提交
270
        return 0;
271
    }
B
balrog 已提交
272 273
}

274 275
#define TO_CPSR (1 << 20)

276
typedef enum {
277 278 279 280 281 282 283 284 285 286 287 288 289 290 291
    ARITH_AND = 0x0 << 21,
    ARITH_EOR = 0x1 << 21,
    ARITH_SUB = 0x2 << 21,
    ARITH_RSB = 0x3 << 21,
    ARITH_ADD = 0x4 << 21,
    ARITH_ADC = 0x5 << 21,
    ARITH_SBC = 0x6 << 21,
    ARITH_RSC = 0x7 << 21,
    ARITH_TST = 0x8 << 21 | TO_CPSR,
    ARITH_CMP = 0xa << 21 | TO_CPSR,
    ARITH_CMN = 0xb << 21 | TO_CPSR,
    ARITH_ORR = 0xc << 21,
    ARITH_MOV = 0xd << 21,
    ARITH_BIC = 0xe << 21,
    ARITH_MVN = 0xf << 21,
292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310

    INSN_LDR_IMM   = 0x04100000,
    INSN_LDR_REG   = 0x06100000,
    INSN_STR_IMM   = 0x04000000,
    INSN_STR_REG   = 0x06000000,

    INSN_LDRH_IMM  = 0x005000b0,
    INSN_LDRH_REG  = 0x001000b0,
    INSN_LDRSH_IMM = 0x005000f0,
    INSN_LDRSH_REG = 0x001000f0,
    INSN_STRH_IMM  = 0x004000b0,
    INSN_STRH_REG  = 0x000000b0,

    INSN_LDRB_IMM  = 0x04500000,
    INSN_LDRB_REG  = 0x06500000,
    INSN_LDRSB_IMM = 0x005000d0,
    INSN_LDRSB_REG = 0x001000d0,
    INSN_STRB_IMM  = 0x04400000,
    INSN_STRB_REG  = 0x06400000,
311 312

    INSN_LDRD_IMM  = 0x004000d0,
313 314 315
    INSN_LDRD_REG  = 0x000000d0,
    INSN_STRD_IMM  = 0x004000f0,
    INSN_STRD_REG  = 0x000000f0,
316
} ARMInsn;
B
balrog 已提交
317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344

#define SHIFT_IMM_LSL(im)	(((im) << 7) | 0x00)
#define SHIFT_IMM_LSR(im)	(((im) << 7) | 0x20)
#define SHIFT_IMM_ASR(im)	(((im) << 7) | 0x40)
#define SHIFT_IMM_ROR(im)	(((im) << 7) | 0x60)
#define SHIFT_REG_LSL(rs)	(((rs) << 8) | 0x10)
#define SHIFT_REG_LSR(rs)	(((rs) << 8) | 0x30)
#define SHIFT_REG_ASR(rs)	(((rs) << 8) | 0x50)
#define SHIFT_REG_ROR(rs)	(((rs) << 8) | 0x70)

enum arm_cond_code_e {
    COND_EQ = 0x0,
    COND_NE = 0x1,
    COND_CS = 0x2,	/* Unsigned greater or equal */
    COND_CC = 0x3,	/* Unsigned less than */
    COND_MI = 0x4,	/* Negative */
    COND_PL = 0x5,	/* Zero or greater */
    COND_VS = 0x6,	/* Overflow */
    COND_VC = 0x7,	/* No overflow */
    COND_HI = 0x8,	/* Unsigned greater than */
    COND_LS = 0x9,	/* Unsigned less or equal */
    COND_GE = 0xa,
    COND_LT = 0xb,
    COND_GT = 0xc,
    COND_LE = 0xd,
    COND_AL = 0xe,
};

345
static const uint8_t tcg_cond_to_arm_cond[] = {
B
balrog 已提交
346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369
    [TCG_COND_EQ] = COND_EQ,
    [TCG_COND_NE] = COND_NE,
    [TCG_COND_LT] = COND_LT,
    [TCG_COND_GE] = COND_GE,
    [TCG_COND_LE] = COND_LE,
    [TCG_COND_GT] = COND_GT,
    /* unsigned */
    [TCG_COND_LTU] = COND_CC,
    [TCG_COND_GEU] = COND_CS,
    [TCG_COND_LEU] = COND_LS,
    [TCG_COND_GTU] = COND_HI,
};

static inline void tcg_out_bx(TCGContext *s, int cond, int rn)
{
    tcg_out32(s, (cond << 28) | 0x012fff10 | rn);
}

static inline void tcg_out_b(TCGContext *s, int cond, int32_t offset)
{
    tcg_out32(s, (cond << 28) | 0x0a000000 |
                    (((offset - 8) >> 2) & 0x00ffffff));
}

370 371
static inline void tcg_out_b_noaddr(TCGContext *s, int cond)
{
372 373
    /* We pay attention here to not modify the branch target by masking
       the corresponding bytes.  This ensure that caches and memory are
374
       kept coherent during retranslation. */
375
    tcg_out32(s, deposit32(*s->code_ptr, 24, 8, (cond << 4) | 0x0a));
376 377 378 379
}

static inline void tcg_out_bl_noaddr(TCGContext *s, int cond)
{
380 381
    /* We pay attention here to not modify the branch target by masking
       the corresponding bytes.  This ensure that caches and memory are
382
       kept coherent during retranslation. */
383
    tcg_out32(s, deposit32(*s->code_ptr, 24, 8, (cond << 4) | 0x0b));
384 385
}

B
balrog 已提交
386 387 388 389 390 391
static inline void tcg_out_bl(TCGContext *s, int cond, int32_t offset)
{
    tcg_out32(s, (cond << 28) | 0x0b000000 |
                    (((offset - 8) >> 2) & 0x00ffffff));
}

392 393 394 395 396
static inline void tcg_out_blx(TCGContext *s, int cond, int rn)
{
    tcg_out32(s, (cond << 28) | 0x012fff30 | rn);
}

397 398 399 400 401 402
static inline void tcg_out_blx_imm(TCGContext *s, int32_t offset)
{
    tcg_out32(s, 0xfa000000 | ((offset & 2) << 23) |
                (((offset - 8) >> 2) & 0x00ffffff));
}

B
balrog 已提交
403 404 405
static inline void tcg_out_dat_reg(TCGContext *s,
                int cond, int opc, int rd, int rn, int rm, int shift)
{
406
    tcg_out32(s, (cond << 28) | (0 << 25) | opc |
B
balrog 已提交
407 408 409
                    (rn << 16) | (rd << 12) | shift | rm);
}

410 411 412 413 414 415 416 417 418 419 420 421 422 423
static inline void tcg_out_nop(TCGContext *s)
{
    if (use_armv7_instructions) {
        /* Architected nop introduced in v6k.  */
        /* ??? This is an MSR (imm) 0,0,0 insn.  Anyone know if this
           also Just So Happened to do nothing on pre-v6k so that we
           don't need to conditionalize it?  */
        tcg_out32(s, 0xe320f000);
    } else {
        /* Prior to that the assembler uses mov r0, r0.  */
        tcg_out_dat_reg(s, COND_AL, ARITH_MOV, 0, 0, 0, SHIFT_IMM_LSL(0));
    }
}

424 425 426 427 428 429 430 431
static inline void tcg_out_mov_reg(TCGContext *s, int cond, int rd, int rm)
{
    /* Simple reg-reg move, optimising out the 'do nothing' case */
    if (rd != rm) {
        tcg_out_dat_reg(s, cond, ARITH_MOV, rd, 0, rm, SHIFT_IMM_LSL(0));
    }
}

B
balrog 已提交
432 433 434
static inline void tcg_out_dat_imm(TCGContext *s,
                int cond, int opc, int rd, int rn, int im)
{
435
    tcg_out32(s, (cond << 28) | (1 << 25) | opc |
B
balrog 已提交
436 437 438
                    (rn << 16) | (rd << 12) | im);
}

439
static void tcg_out_movi32(TCGContext *s, int cond, int rd, uint32_t arg)
B
balrog 已提交
440
{
441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463
    int rot, opc, rn;

    /* For armv7, make sure not to use movw+movt when mov/mvn would do.
       Speed things up by only checking when movt would be required.
       Prior to armv7, have one go at fully rotated immediates before
       doing the decomposition thing below.  */
    if (!use_armv7_instructions || (arg & 0xffff0000)) {
        rot = encode_imm(arg);
        if (rot >= 0) {
            tcg_out_dat_imm(s, cond, ARITH_MOV, rd, 0,
                            rotl(arg, rot) | (rot << 7));
            return;
        }
        rot = encode_imm(~arg);
        if (rot >= 0) {
            tcg_out_dat_imm(s, cond, ARITH_MVN, rd, 0,
                            rotl(~arg, rot) | (rot << 7));
            return;
        }
    }

    /* Use movw + movt.  */
    if (use_armv7_instructions) {
464 465 466
        /* movw */
        tcg_out32(s, (cond << 28) | 0x03000000 | (rd << 12)
                  | ((arg << 4) & 0x000f0000) | (arg & 0xfff));
467
        if (arg & 0xffff0000) {
468 469 470 471
            /* movt */
            tcg_out32(s, (cond << 28) | 0x03400000 | (rd << 12)
                      | ((arg >> 12) & 0x000f0000) | ((arg >> 16) & 0xfff));
        }
472 473
        return;
    }
474

475 476 477 478 479 480 481 482
    /* TODO: This is very suboptimal, we can easily have a constant
       pool somewhere after all the instructions.  */
    opc = ARITH_MOV;
    rn = 0;
    /* If we have lots of leading 1's, we can shorten the sequence by
       beginning with mvn and then clearing higher bits with eor.  */
    if (clz32(~arg) > clz32(arg)) {
        opc = ARITH_MVN, arg = ~arg;
483
    }
484 485 486 487 488 489 490 491 492
    do {
        int i = ctz32(arg) & ~1;
        rot = ((32 - i) << 7) & 0xf00;
        tcg_out_dat_imm(s, cond, opc, rd, rn, ((arg >> i) & 0xff) | rot);
        arg &= ~(0xff << i);

        opc = ARITH_EOR;
        rn = rd;
    } while (arg);
B
balrog 已提交
493 494
}

495 496 497 498 499 500 501 502
static inline void tcg_out_dat_rI(TCGContext *s, int cond, int opc, TCGArg dst,
                                  TCGArg lhs, TCGArg rhs, int rhs_is_const)
{
    /* Emit either the reg,imm or reg,reg form of a data-processing insn.
     * rhs must satisfy the "rI" constraint.
     */
    if (rhs_is_const) {
        int rot = encode_imm(rhs);
503
        tcg_debug_assert(rot >= 0);
504 505 506 507 508 509
        tcg_out_dat_imm(s, cond, opc, dst, lhs, rotl(rhs, rot) | (rot << 7));
    } else {
        tcg_out_dat_reg(s, cond, opc, dst, lhs, rhs, SHIFT_IMM_LSL(0));
    }
}

510 511 512 513 514 515 516 517 518 519 520 521
static void tcg_out_dat_rIK(TCGContext *s, int cond, int opc, int opinv,
                            TCGReg dst, TCGReg lhs, TCGArg rhs,
                            bool rhs_is_const)
{
    /* Emit either the reg,imm or reg,reg form of a data-processing insn.
     * rhs must satisfy the "rIK" constraint.
     */
    if (rhs_is_const) {
        int rot = encode_imm(rhs);
        if (rot < 0) {
            rhs = ~rhs;
            rot = encode_imm(rhs);
522
            tcg_debug_assert(rot >= 0);
523 524 525 526 527 528 529 530
            opc = opinv;
        }
        tcg_out_dat_imm(s, cond, opc, dst, lhs, rotl(rhs, rot) | (rot << 7));
    } else {
        tcg_out_dat_reg(s, cond, opc, dst, lhs, rhs, SHIFT_IMM_LSL(0));
    }
}

531 532 533 534 535 536 537 538 539 540 541 542
static void tcg_out_dat_rIN(TCGContext *s, int cond, int opc, int opneg,
                            TCGArg dst, TCGArg lhs, TCGArg rhs,
                            bool rhs_is_const)
{
    /* Emit either the reg,imm or reg,reg form of a data-processing insn.
     * rhs must satisfy the "rIN" constraint.
     */
    if (rhs_is_const) {
        int rot = encode_imm(rhs);
        if (rot < 0) {
            rhs = -rhs;
            rot = encode_imm(rhs);
543
            tcg_debug_assert(rot >= 0);
544 545 546 547 548 549 550 551
            opc = opneg;
        }
        tcg_out_dat_imm(s, cond, opc, dst, lhs, rotl(rhs, rot) | (rot << 7));
    } else {
        tcg_out_dat_reg(s, cond, opc, dst, lhs, rhs, SHIFT_IMM_LSL(0));
    }
}

552 553
static inline void tcg_out_mul32(TCGContext *s, int cond, TCGReg rd,
                                 TCGReg rn, TCGReg rm)
B
balrog 已提交
554
{
555 556 557 558 559 560 561 562 563 564
    /* if ArchVersion() < 6 && d == n then UNPREDICTABLE;  */
    if (!use_armv6_instructions && rd == rn) {
        if (rd == rm) {
            /* rd == rn == rm; copy an input to tmp first.  */
            tcg_out_mov_reg(s, cond, TCG_REG_TMP, rn);
            rm = rn = TCG_REG_TMP;
        } else {
            rn = rm;
            rm = rd;
        }
B
balrog 已提交
565
    }
566 567
    /* mul */
    tcg_out32(s, (cond << 28) | 0x90 | (rd << 16) | (rm << 8) | rn);
B
balrog 已提交
568 569
}

570 571
static inline void tcg_out_umull32(TCGContext *s, int cond, TCGReg rd0,
                                   TCGReg rd1, TCGReg rn, TCGReg rm)
B
balrog 已提交
572
{
573 574 575 576 577 578 579 580 581 582
    /* if ArchVersion() < 6 && (dHi == n || dLo == n) then UNPREDICTABLE;  */
    if (!use_armv6_instructions && (rd0 == rn || rd1 == rn)) {
        if (rd0 == rm || rd1 == rm) {
            tcg_out_mov_reg(s, cond, TCG_REG_TMP, rn);
            rn = TCG_REG_TMP;
        } else {
            TCGReg t = rn;
            rn = rm;
            rm = t;
        }
B
balrog 已提交
583
    }
584 585 586
    /* umull */
    tcg_out32(s, (cond << 28) | 0x00800090 |
              (rd1 << 16) | (rd0 << 12) | (rm << 8) | rn);
B
balrog 已提交
587 588
}

589 590
static inline void tcg_out_smull32(TCGContext *s, int cond, TCGReg rd0,
                                   TCGReg rd1, TCGReg rn, TCGReg rm)
B
balrog 已提交
591
{
592 593 594 595 596 597 598 599 600 601
    /* if ArchVersion() < 6 && (dHi == n || dLo == n) then UNPREDICTABLE;  */
    if (!use_armv6_instructions && (rd0 == rn || rd1 == rn)) {
        if (rd0 == rm || rd1 == rm) {
            tcg_out_mov_reg(s, cond, TCG_REG_TMP, rn);
            rn = TCG_REG_TMP;
        } else {
            TCGReg t = rn;
            rn = rm;
            rm = t;
        }
B
balrog 已提交
602
    }
603 604 605
    /* smull */
    tcg_out32(s, (cond << 28) | 0x00c00090 |
              (rd1 << 16) | (rd0 << 12) | (rm << 8) | rn);
B
balrog 已提交
606 607
}

608 609 610 611 612 613 614 615 616 617
static inline void tcg_out_sdiv(TCGContext *s, int cond, int rd, int rn, int rm)
{
    tcg_out32(s, 0x0710f010 | (cond << 28) | (rd << 16) | rn | (rm << 8));
}

static inline void tcg_out_udiv(TCGContext *s, int cond, int rd, int rn, int rm)
{
    tcg_out32(s, 0x0730f010 | (cond << 28) | (rd << 16) | rn | (rm << 8));
}

A
Aurelien Jarno 已提交
618 619 620 621 622 623 624
static inline void tcg_out_ext8s(TCGContext *s, int cond,
                                 int rd, int rn)
{
    if (use_armv6_instructions) {
        /* sxtb */
        tcg_out32(s, 0x06af0070 | (cond << 28) | (rd << 12) | rn);
    } else {
625
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
626
                        rd, 0, rn, SHIFT_IMM_LSL(24));
627
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
628 629 630 631
                        rd, 0, rd, SHIFT_IMM_ASR(24));
    }
}

632 633 634 635 636 637
static inline void tcg_out_ext8u(TCGContext *s, int cond,
                                 int rd, int rn)
{
    tcg_out_dat_imm(s, cond, ARITH_AND, rd, rn, 0xff);
}

A
Aurelien Jarno 已提交
638 639 640 641 642 643 644
static inline void tcg_out_ext16s(TCGContext *s, int cond,
                                  int rd, int rn)
{
    if (use_armv6_instructions) {
        /* sxth */
        tcg_out32(s, 0x06bf0070 | (cond << 28) | (rd << 12) | rn);
    } else {
645
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
646
                        rd, 0, rn, SHIFT_IMM_LSL(16));
647
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
648 649 650 651 652 653 654 655 656 657 658
                        rd, 0, rd, SHIFT_IMM_ASR(16));
    }
}

static inline void tcg_out_ext16u(TCGContext *s, int cond,
                                  int rd, int rn)
{
    if (use_armv6_instructions) {
        /* uxth */
        tcg_out32(s, 0x06ff0070 | (cond << 28) | (rd << 12) | rn);
    } else {
659
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
660
                        rd, 0, rn, SHIFT_IMM_LSL(16));
661
        tcg_out_dat_reg(s, cond, ARITH_MOV,
A
Aurelien Jarno 已提交
662 663 664 665
                        rd, 0, rd, SHIFT_IMM_LSR(16));
    }
}

666 667 668 669 670 671 672
static inline void tcg_out_bswap16s(TCGContext *s, int cond, int rd, int rn)
{
    if (use_armv6_instructions) {
        /* revsh */
        tcg_out32(s, 0x06ff0fb0 | (cond << 28) | (rd << 12) | rn);
    } else {
        tcg_out_dat_reg(s, cond, ARITH_MOV,
673
                        TCG_REG_TMP, 0, rn, SHIFT_IMM_LSL(24));
674
        tcg_out_dat_reg(s, cond, ARITH_MOV,
675
                        TCG_REG_TMP, 0, TCG_REG_TMP, SHIFT_IMM_ASR(16));
676
        tcg_out_dat_reg(s, cond, ARITH_ORR,
677
                        rd, TCG_REG_TMP, rn, SHIFT_IMM_LSR(8));
678 679 680
    }
}

A
Aurelien Jarno 已提交
681 682 683 684 685 686 687
static inline void tcg_out_bswap16(TCGContext *s, int cond, int rd, int rn)
{
    if (use_armv6_instructions) {
        /* rev16 */
        tcg_out32(s, 0x06bf0fb0 | (cond << 28) | (rd << 12) | rn);
    } else {
        tcg_out_dat_reg(s, cond, ARITH_MOV,
688
                        TCG_REG_TMP, 0, rn, SHIFT_IMM_LSL(24));
A
Aurelien Jarno 已提交
689
        tcg_out_dat_reg(s, cond, ARITH_MOV,
690
                        TCG_REG_TMP, 0, TCG_REG_TMP, SHIFT_IMM_LSR(16));
A
Aurelien Jarno 已提交
691
        tcg_out_dat_reg(s, cond, ARITH_ORR,
692
                        rd, TCG_REG_TMP, rn, SHIFT_IMM_LSR(8));
A
Aurelien Jarno 已提交
693 694 695
    }
}

696 697 698 699 700 701 702 703 704
/* swap the two low bytes assuming that the two high input bytes and the
   two high output bit can hold any value. */
static inline void tcg_out_bswap16st(TCGContext *s, int cond, int rd, int rn)
{
    if (use_armv6_instructions) {
        /* rev16 */
        tcg_out32(s, 0x06bf0fb0 | (cond << 28) | (rd << 12) | rn);
    } else {
        tcg_out_dat_reg(s, cond, ARITH_MOV,
705 706
                        TCG_REG_TMP, 0, rn, SHIFT_IMM_LSR(8));
        tcg_out_dat_imm(s, cond, ARITH_AND, TCG_REG_TMP, TCG_REG_TMP, 0xff);
707
        tcg_out_dat_reg(s, cond, ARITH_ORR,
708
                        rd, TCG_REG_TMP, rn, SHIFT_IMM_LSL(8));
709 710 711
    }
}

A
Aurelien Jarno 已提交
712 713 714 715 716 717 718
static inline void tcg_out_bswap32(TCGContext *s, int cond, int rd, int rn)
{
    if (use_armv6_instructions) {
        /* rev */
        tcg_out32(s, 0x06bf0f30 | (cond << 28) | (rd << 12) | rn);
    } else {
        tcg_out_dat_reg(s, cond, ARITH_EOR,
719
                        TCG_REG_TMP, rn, rn, SHIFT_IMM_ROR(16));
A
Aurelien Jarno 已提交
720
        tcg_out_dat_imm(s, cond, ARITH_BIC,
721
                        TCG_REG_TMP, TCG_REG_TMP, 0xff | 0x800);
A
Aurelien Jarno 已提交
722 723 724
        tcg_out_dat_reg(s, cond, ARITH_MOV,
                        rd, 0, rn, SHIFT_IMM_ROR(8));
        tcg_out_dat_reg(s, cond, ARITH_EOR,
725
                        rd, rd, TCG_REG_TMP, SHIFT_IMM_LSR(8));
A
Aurelien Jarno 已提交
726 727 728
    }
}

729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750
bool tcg_target_deposit_valid(int ofs, int len)
{
    /* ??? Without bfi, we could improve over generic code by combining
       the right-shift from a non-zero ofs with the orr.  We do run into
       problems when rd == rs, and the mask generated from ofs+len doesn't
       fit into an immediate.  We would have to be careful not to pessimize
       wrt the optimizations performed on the expanded code.  */
    return use_armv7_instructions;
}

static inline void tcg_out_deposit(TCGContext *s, int cond, TCGReg rd,
                                   TCGArg a1, int ofs, int len, bool const_a1)
{
    if (const_a1) {
        /* bfi becomes bfc with rn == 15.  */
        a1 = 15;
    }
    /* bfi/bfc */
    tcg_out32(s, 0x07c00010 | (cond << 28) | (rd << 12) | a1
              | (ofs << 7) | ((ofs + len - 1) << 16));
}

751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773
/* Note that this routine is used for both LDR and LDRH formats, so we do
   not wish to include an immediate shift at this point.  */
static void tcg_out_memop_r(TCGContext *s, int cond, ARMInsn opc, TCGReg rt,
                            TCGReg rn, TCGReg rm, bool u, bool p, bool w)
{
    tcg_out32(s, (cond << 28) | opc | (u << 23) | (p << 24)
              | (w << 21) | (rn << 16) | (rt << 12) | rm);
}

static void tcg_out_memop_8(TCGContext *s, int cond, ARMInsn opc, TCGReg rt,
                            TCGReg rn, int imm8, bool p, bool w)
{
    bool u = 1;
    if (imm8 < 0) {
        imm8 = -imm8;
        u = 0;
    }
    tcg_out32(s, (cond << 28) | opc | (u << 23) | (p << 24) | (w << 21) |
              (rn << 16) | (rt << 12) | ((imm8 & 0xf0) << 4) | (imm8 & 0xf));
}

static void tcg_out_memop_12(TCGContext *s, int cond, ARMInsn opc, TCGReg rt,
                             TCGReg rn, int imm12, bool p, bool w)
B
balrog 已提交
774
{
775 776 777 778 779 780 781 782 783 784 785 786 787
    bool u = 1;
    if (imm12 < 0) {
        imm12 = -imm12;
        u = 0;
    }
    tcg_out32(s, (cond << 28) | opc | (u << 23) | (p << 24) | (w << 21) |
              (rn << 16) | (rt << 12) | imm12);
}

static inline void tcg_out_ld32_12(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm12)
{
    tcg_out_memop_12(s, cond, INSN_LDR_IMM, rt, rn, imm12, 1, 0);
B
balrog 已提交
788 789
}

790 791
static inline void tcg_out_st32_12(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm12)
B
balrog 已提交
792
{
793
    tcg_out_memop_12(s, cond, INSN_STR_IMM, rt, rn, imm12, 1, 0);
B
balrog 已提交
794 795
}

796 797
static inline void tcg_out_ld32_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
B
balrog 已提交
798
{
799
    tcg_out_memop_r(s, cond, INSN_LDR_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
800 801
}

802 803
static inline void tcg_out_st32_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
B
balrog 已提交
804
{
805
    tcg_out_memop_r(s, cond, INSN_STR_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
806 807
}

808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
static inline void tcg_out_ldrd_8(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm8)
{
    tcg_out_memop_8(s, cond, INSN_LDRD_IMM, rt, rn, imm8, 1, 0);
}

static inline void tcg_out_ldrd_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
{
    tcg_out_memop_r(s, cond, INSN_LDRD_REG, rt, rn, rm, 1, 1, 0);
}

static inline void tcg_out_strd_8(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm8)
{
    tcg_out_memop_8(s, cond, INSN_STRD_IMM, rt, rn, imm8, 1, 0);
}

static inline void tcg_out_strd_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
{
    tcg_out_memop_r(s, cond, INSN_STRD_REG, rt, rn, rm, 1, 1, 0);
}

P
pbrook 已提交
832
/* Register pre-increment with base writeback.  */
833 834
static inline void tcg_out_ld32_rwb(TCGContext *s, int cond, TCGReg rt,
                                    TCGReg rn, TCGReg rm)
P
pbrook 已提交
835
{
836
    tcg_out_memop_r(s, cond, INSN_LDR_REG, rt, rn, rm, 1, 1, 1);
P
pbrook 已提交
837 838
}

839 840
static inline void tcg_out_st32_rwb(TCGContext *s, int cond, TCGReg rt,
                                    TCGReg rn, TCGReg rm)
P
pbrook 已提交
841
{
842
    tcg_out_memop_r(s, cond, INSN_STR_REG, rt, rn, rm, 1, 1, 1);
P
pbrook 已提交
843 844
}

845 846
static inline void tcg_out_ld16u_8(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm8)
B
balrog 已提交
847
{
848
    tcg_out_memop_8(s, cond, INSN_LDRH_IMM, rt, rn, imm8, 1, 0);
B
balrog 已提交
849 850
}

851 852
static inline void tcg_out_st16_8(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, int imm8)
B
balrog 已提交
853
{
854
    tcg_out_memop_8(s, cond, INSN_STRH_IMM, rt, rn, imm8, 1, 0);
B
balrog 已提交
855 856
}

857 858
static inline void tcg_out_ld16u_r(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, TCGReg rm)
B
balrog 已提交
859
{
860
    tcg_out_memop_r(s, cond, INSN_LDRH_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
861 862
}

863 864
static inline void tcg_out_st16_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
B
balrog 已提交
865
{
866
    tcg_out_memop_r(s, cond, INSN_STRH_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
867 868
}

869 870
static inline void tcg_out_ld16s_8(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, int imm8)
B
balrog 已提交
871
{
872
    tcg_out_memop_8(s, cond, INSN_LDRSH_IMM, rt, rn, imm8, 1, 0);
B
balrog 已提交
873 874
}

875 876
static inline void tcg_out_ld16s_r(TCGContext *s, int cond, TCGReg rt,
                                   TCGReg rn, TCGReg rm)
B
balrog 已提交
877
{
878
    tcg_out_memop_r(s, cond, INSN_LDRSH_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
879 880
}

881 882
static inline void tcg_out_ld8_12(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, int imm12)
B
balrog 已提交
883
{
884
    tcg_out_memop_12(s, cond, INSN_LDRB_IMM, rt, rn, imm12, 1, 0);
B
balrog 已提交
885 886
}

887 888
static inline void tcg_out_st8_12(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, int imm12)
B
balrog 已提交
889
{
890
    tcg_out_memop_12(s, cond, INSN_STRB_IMM, rt, rn, imm12, 1, 0);
B
balrog 已提交
891 892
}

893 894
static inline void tcg_out_ld8_r(TCGContext *s, int cond, TCGReg rt,
                                 TCGReg rn, TCGReg rm)
B
balrog 已提交
895
{
896
    tcg_out_memop_r(s, cond, INSN_LDRB_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
897 898
}

899 900
static inline void tcg_out_st8_r(TCGContext *s, int cond, TCGReg rt,
                                 TCGReg rn, TCGReg rm)
B
balrog 已提交
901
{
902
    tcg_out_memop_r(s, cond, INSN_STRB_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
903 904
}

905 906
static inline void tcg_out_ld8s_8(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, int imm8)
B
balrog 已提交
907
{
908
    tcg_out_memop_8(s, cond, INSN_LDRSB_IMM, rt, rn, imm8, 1, 0);
B
balrog 已提交
909 910
}

911 912
static inline void tcg_out_ld8s_r(TCGContext *s, int cond, TCGReg rt,
                                  TCGReg rn, TCGReg rm)
B
balrog 已提交
913
{
914
    tcg_out_memop_r(s, cond, INSN_LDRSB_REG, rt, rn, rm, 1, 1, 0);
B
balrog 已提交
915 916 917 918 919 920
}

static inline void tcg_out_ld32u(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xfff || offset < -0xfff) {
921 922
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_ld32_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
923 924 925 926 927 928 929 930
    } else
        tcg_out_ld32_12(s, cond, rd, rn, offset);
}

static inline void tcg_out_st32(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xfff || offset < -0xfff) {
931 932
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_st32_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
933 934 935 936 937 938 939 940
    } else
        tcg_out_st32_12(s, cond, rd, rn, offset);
}

static inline void tcg_out_ld16u(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xff || offset < -0xff) {
941 942
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_ld16u_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
943 944 945 946 947 948 949 950
    } else
        tcg_out_ld16u_8(s, cond, rd, rn, offset);
}

static inline void tcg_out_ld16s(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xff || offset < -0xff) {
951 952
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_ld16s_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
953 954 955 956
    } else
        tcg_out_ld16s_8(s, cond, rd, rn, offset);
}

957
static inline void tcg_out_st16(TCGContext *s, int cond,
B
balrog 已提交
958 959 960
                int rd, int rn, int32_t offset)
{
    if (offset > 0xff || offset < -0xff) {
961 962
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_st16_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
963
    } else
964
        tcg_out_st16_8(s, cond, rd, rn, offset);
B
balrog 已提交
965 966 967 968 969 970
}

static inline void tcg_out_ld8u(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xfff || offset < -0xfff) {
971 972
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_ld8_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
973 974 975 976 977 978 979 980
    } else
        tcg_out_ld8_12(s, cond, rd, rn, offset);
}

static inline void tcg_out_ld8s(TCGContext *s, int cond,
                int rd, int rn, int32_t offset)
{
    if (offset > 0xff || offset < -0xff) {
981 982
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_ld8s_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
983 984 985 986
    } else
        tcg_out_ld8s_8(s, cond, rd, rn, offset);
}

987
static inline void tcg_out_st8(TCGContext *s, int cond,
B
balrog 已提交
988 989 990
                int rd, int rn, int32_t offset)
{
    if (offset > 0xfff || offset < -0xfff) {
991 992
        tcg_out_movi32(s, cond, TCG_REG_TMP, offset);
        tcg_out_st8_r(s, cond, rd, rn, TCG_REG_TMP);
B
balrog 已提交
993 994 995 996
    } else
        tcg_out_st8_12(s, cond, rd, rn, offset);
}

997 998 999
/* The _goto case is normally between TBs within the same code buffer, and
 * with the code buffer limited to 16MB we wouldn't need the long case.
 * But we also use it for the tail-call to the qemu_ld/st helpers, which does.
1000
 */
1001
static inline void tcg_out_goto(TCGContext *s, int cond, tcg_insn_unit *addr)
B
balrog 已提交
1002
{
1003 1004
    intptr_t addri = (intptr_t)addr;
    ptrdiff_t disp = tcg_pcrel_diff(s, addr);
B
balrog 已提交
1005

1006
    if ((addri & 1) == 0 && disp - 8 < 0x01fffffd && disp - 8 > -0x01fffffd) {
1007 1008
        tcg_out_b(s, cond, disp);
        return;
1009 1010
    }

1011
    tcg_out_movi32(s, cond, TCG_REG_TMP, addri);
1012 1013 1014
    if (use_armv5t_instructions) {
        tcg_out_bx(s, cond, TCG_REG_TMP);
    } else {
1015
        if (addri & 1) {
1016
            tcg_abort();
B
balrog 已提交
1017
        }
1018
        tcg_out_mov_reg(s, cond, TCG_REG_PC, TCG_REG_TMP);
B
balrog 已提交
1019 1020 1021
    }
}

1022 1023
/* The call case is mostly used for helpers - so it's not unreasonable
 * for them to be beyond branch range */
1024
static void tcg_out_call(TCGContext *s, tcg_insn_unit *addr)
B
balrog 已提交
1025
{
1026 1027
    intptr_t addri = (intptr_t)addr;
    ptrdiff_t disp = tcg_pcrel_diff(s, addr);
B
balrog 已提交
1028

1029 1030
    if (disp - 8 < 0x02000000 && disp - 8 >= -0x02000000) {
        if (addri & 1) {
1031
            /* Use BLX if the target is in Thumb mode */
1032
            if (!use_armv5t_instructions) {
1033 1034
                tcg_abort();
            }
1035
            tcg_out_blx_imm(s, disp);
1036
        } else {
1037
            tcg_out_bl(s, COND_AL, disp);
1038
        }
1039
    } else if (use_armv7_instructions) {
1040
        tcg_out_movi32(s, COND_AL, TCG_REG_TMP, addri);
1041
        tcg_out_blx(s, COND_AL, TCG_REG_TMP);
1042
    } else {
1043 1044
        tcg_out_dat_imm(s, COND_AL, ARITH_ADD, TCG_REG_R14, TCG_REG_PC, 4);
        tcg_out_ld32_12(s, COND_AL, TCG_REG_PC, TCG_REG_PC, -4);
1045
        tcg_out32(s, addri);
B
balrog 已提交
1046 1047 1048
    }
}

1049 1050 1051 1052 1053 1054 1055 1056 1057 1058
void arm_tb_set_jmp_target(uintptr_t jmp_addr, uintptr_t addr)
{
    tcg_insn_unit *code_ptr = (tcg_insn_unit *)jmp_addr;
    tcg_insn_unit *target = (tcg_insn_unit *)addr;

    /* we could use a ldr pc, [pc, #-4] kind of branch and avoid the flush */
    reloc_pc24_atomic(code_ptr, target);
    flush_icache_range(jmp_addr, jmp_addr + 4);
}

1059
static inline void tcg_out_goto_label(TCGContext *s, int cond, TCGLabel *l)
B
balrog 已提交
1060
{
1061
    if (l->has_value) {
1062
        tcg_out_goto(s, cond, l->u.value_ptr);
B
balrog 已提交
1063
    } else {
1064
        tcg_out_reloc(s, s->code_ptr, R_ARM_PC24, l, 0);
1065
        tcg_out_b_noaddr(s, cond);
B
balrog 已提交
1066 1067 1068 1069
    }
}

#ifdef CONFIG_SOFTMMU
1070 1071 1072
/* helper signature: helper_ret_ld_mmu(CPUState *env, target_ulong addr,
 *                                     int mmu_idx, uintptr_t ra)
 */
1073
static void * const qemu_ld_helpers[16] = {
1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087
    [MO_UB]   = helper_ret_ldub_mmu,
    [MO_SB]   = helper_ret_ldsb_mmu,

    [MO_LEUW] = helper_le_lduw_mmu,
    [MO_LEUL] = helper_le_ldul_mmu,
    [MO_LEQ]  = helper_le_ldq_mmu,
    [MO_LESW] = helper_le_ldsw_mmu,
    [MO_LESL] = helper_le_ldul_mmu,

    [MO_BEUW] = helper_be_lduw_mmu,
    [MO_BEUL] = helper_be_ldul_mmu,
    [MO_BEQ]  = helper_be_ldq_mmu,
    [MO_BESW] = helper_be_ldsw_mmu,
    [MO_BESL] = helper_be_ldul_mmu,
1088 1089
};

1090 1091 1092
/* helper signature: helper_ret_st_mmu(CPUState *env, target_ulong addr,
 *                                     uintxx_t val, int mmu_idx, uintptr_t ra)
 */
1093
static void * const qemu_st_helpers[16] = {
1094 1095 1096 1097 1098 1099 1100
    [MO_UB]   = helper_ret_stb_mmu,
    [MO_LEUW] = helper_le_stw_mmu,
    [MO_LEUL] = helper_le_stl_mmu,
    [MO_LEQ]  = helper_le_stq_mmu,
    [MO_BEUW] = helper_be_stw_mmu,
    [MO_BEUL] = helper_be_stl_mmu,
    [MO_BEQ]  = helper_be_stq_mmu,
1101
};
1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112

/* Helper routines for marshalling helper function arguments into
 * the correct registers and stack.
 * argreg is where we want to put this argument, arg is the argument itself.
 * Return value is the updated argreg ready for the next call.
 * Note that argreg 0..3 is real registers, 4+ on stack.
 *
 * We provide routines for arguments which are: immediate, 32 bit
 * value in register, 16 and 8 bit values in register (which must be zero
 * extended before use) and 64 bit value in a lo:hi register pair.
 */
1113 1114 1115 1116 1117 1118 1119 1120
#define DEFINE_TCG_OUT_ARG(NAME, ARGTYPE, MOV_ARG, EXT_ARG)                \
static TCGReg NAME(TCGContext *s, TCGReg argreg, ARGTYPE arg)              \
{                                                                          \
    if (argreg < 4) {                                                      \
        MOV_ARG(s, COND_AL, argreg, arg);                                  \
    } else {                                                               \
        int ofs = (argreg - 4) * 4;                                        \
        EXT_ARG;                                                           \
1121
        tcg_debug_assert(ofs + 4 <= TCG_STATIC_CALL_ARGS_SIZE);            \
1122 1123 1124 1125 1126 1127
        tcg_out_st32_12(s, COND_AL, arg, TCG_REG_CALL_STACK, ofs);         \
    }                                                                      \
    return argreg + 1;                                                     \
}

DEFINE_TCG_OUT_ARG(tcg_out_arg_imm32, uint32_t, tcg_out_movi32,
1128
    (tcg_out_movi32(s, COND_AL, TCG_REG_TMP, arg), arg = TCG_REG_TMP))
1129
DEFINE_TCG_OUT_ARG(tcg_out_arg_reg8, TCGReg, tcg_out_ext8u,
1130
    (tcg_out_ext8u(s, COND_AL, TCG_REG_TMP, arg), arg = TCG_REG_TMP))
1131
DEFINE_TCG_OUT_ARG(tcg_out_arg_reg16, TCGReg, tcg_out_ext16u,
1132
    (tcg_out_ext16u(s, COND_AL, TCG_REG_TMP, arg), arg = TCG_REG_TMP))
1133 1134 1135 1136
DEFINE_TCG_OUT_ARG(tcg_out_arg_reg32, TCGReg, tcg_out_mov_reg, )

static TCGReg tcg_out_arg_reg64(TCGContext *s, TCGReg argreg,
                                TCGReg arglo, TCGReg arghi)
1137 1138 1139 1140 1141 1142 1143
{
    /* 64 bit arguments must go in even/odd register pairs
     * and in 8-aligned stack slots.
     */
    if (argreg & 1) {
        argreg++;
    }
1144 1145 1146 1147 1148 1149 1150 1151 1152 1153
    if (use_armv6_instructions && argreg >= 4
        && (arglo & 1) == 0 && arghi == arglo + 1) {
        tcg_out_strd_8(s, COND_AL, arglo,
                       TCG_REG_CALL_STACK, (argreg - 4) * 4);
        return argreg + 2;
    } else {
        argreg = tcg_out_arg_reg32(s, argreg, arglo);
        argreg = tcg_out_arg_reg32(s, argreg, arghi);
        return argreg;
    }
1154
}
B
balrog 已提交
1155

P
pbrook 已提交
1156 1157
#define TLB_SHIFT	(CPU_TLB_ENTRY_BITS + CPU_TLB_BITS)

1158 1159 1160 1161 1162 1163 1164 1165 1166
/* We're expecting to use an 8-bit immediate and to mask.  */
QEMU_BUILD_BUG_ON(CPU_TLB_BITS > 8);

/* We're expecting to use an 8-bit immediate add + 8-bit ldrd offset.
   Using the offset of the second entry in the last tlb table ensures
   that we can index all of the elements of the first entry.  */
QEMU_BUILD_BUG_ON(offsetof(CPUArchState, tlb_table[NB_MMU_MODES - 1][1])
                  > 0xffff);

1167 1168
/* Load and compare a TLB entry, leaving the flags set.  Returns the register
   containing the addend of the tlb entry.  Clobbers R0, R1, R2, TMP.  */
B
balrog 已提交
1169

1170
static TCGReg tcg_out_tlb_read(TCGContext *s, TCGReg addrlo, TCGReg addrhi,
1171
                               TCGMemOp s_bits, int mem_index, bool is_load)
1172
{
1173
    TCGReg base = TCG_AREG0;
1174 1175 1176 1177 1178
    int cmp_off =
        (is_load
         ? offsetof(CPUArchState, tlb_table[mem_index][0].addr_read)
         : offsetof(CPUArchState, tlb_table[mem_index][0].addr_write));
    int add_off = offsetof(CPUArchState, tlb_table[mem_index][0].addend);
1179

1180
    /* Should generate something like the following:
1181
     *   shr    tmp, addrlo, #TARGET_PAGE_BITS                    (1)
1182
     *   add    r2, env, #high
1183 1184
     *   and    r0, tmp, #(CPU_TLB_SIZE - 1)                      (2)
     *   add    r2, r2, r0, lsl #CPU_TLB_ENTRY_BITS               (3)
1185
     *   ldr    r0, [r2, #cmp]                                    (4)
1186 1187
     *   tst    addrlo, #s_mask
     *   ldr    r2, [r2, #add]                                    (5)
1188
     *   cmpeq  r0, tmp, lsl #TARGET_PAGE_BITS
1189
     */
1190
    tcg_out_dat_reg(s, COND_AL, ARITH_MOV, TCG_REG_TMP,
1191
                    0, addrlo, SHIFT_IMM_LSR(TARGET_PAGE_BITS));
1192

1193
    /* We checked that the offset is contained within 16 bits above.  */
1194
    if (add_off > 0xfff || (use_armv6_instructions && cmp_off > 0xff)) {
1195
        tcg_out_dat_imm(s, COND_AL, ARITH_ADD, TCG_REG_R2, base,
1196
                        (24 << 7) | (cmp_off >> 8));
1197
        base = TCG_REG_R2;
1198 1199
        add_off -= cmp_off & 0xff00;
        cmp_off &= 0xff;
1200 1201
    }

B
balrog 已提交
1202
    tcg_out_dat_imm(s, COND_AL, ARITH_AND,
1203
                    TCG_REG_R0, TCG_REG_TMP, CPU_TLB_SIZE - 1);
1204
    tcg_out_dat_reg(s, COND_AL, ARITH_ADD, TCG_REG_R2, base,
1205
                    TCG_REG_R0, SHIFT_IMM_LSL(CPU_TLB_ENTRY_BITS));
1206

1207 1208 1209 1210
    /* Load the tlb comparator.  Use ldrd if needed and available,
       but due to how the pointer needs setting up, ldm isn't useful.
       Base arm5 doesn't have ldrd, but armv5te does.  */
    if (use_armv6_instructions && TARGET_LONG_BITS == 64) {
1211
        tcg_out_ldrd_8(s, COND_AL, TCG_REG_R0, TCG_REG_R2, cmp_off);
1212
    } else {
1213
        tcg_out_ld32_12(s, COND_AL, TCG_REG_R0, TCG_REG_R2, cmp_off);
1214
        if (TARGET_LONG_BITS == 64) {
1215
            tcg_out_ld32_12(s, COND_AL, TCG_REG_R1, TCG_REG_R2, cmp_off + 4);
1216
        }
1217
    }
1218

P
pbrook 已提交
1219
    /* Check alignment.  */
1220
    if (s_bits) {
1221
        tcg_out_dat_imm(s, COND_AL, ARITH_TST,
1222 1223 1224
                        0, addrlo, (1 << s_bits) - 1);
    }

1225 1226 1227
    /* Load the tlb addend.  */
    tcg_out_ld32_12(s, COND_AL, TCG_REG_R2, TCG_REG_R2, add_off);

1228 1229 1230
    tcg_out_dat_reg(s, (s_bits ? COND_EQ : COND_AL), ARITH_CMP, 0,
                    TCG_REG_R0, TCG_REG_TMP, SHIFT_IMM_LSL(TARGET_PAGE_BITS));

1231 1232 1233 1234
    if (TARGET_LONG_BITS == 64) {
        tcg_out_dat_reg(s, COND_EQ, ARITH_CMP, 0,
                        TCG_REG_R1, addrhi, SHIFT_IMM_LSL(0));
    }
1235

1236
    return TCG_REG_R2;
1237
}
1238 1239 1240 1241

/* Record the context of a call to the out of line helper code for the slow
   path for a load or store, so that we can later generate the correct
   helper code.  */
1242
static void add_qemu_ldst_label(TCGContext *s, bool is_ld, TCGMemOpIdx oi,
1243
                                TCGReg datalo, TCGReg datahi, TCGReg addrlo,
1244 1245
                                TCGReg addrhi, tcg_insn_unit *raddr,
                                tcg_insn_unit *label_ptr)
1246
{
R
Richard Henderson 已提交
1247
    TCGLabelQemuLdst *label = new_ldst_label(s);
1248 1249

    label->is_ld = is_ld;
1250
    label->oi = oi;
1251 1252 1253 1254
    label->datalo_reg = datalo;
    label->datahi_reg = datahi;
    label->addrlo_reg = addrlo;
    label->addrhi_reg = addrhi;
1255 1256 1257 1258 1259 1260
    label->raddr = raddr;
    label->label_ptr[0] = label_ptr;
}

static void tcg_out_qemu_ld_slow_path(TCGContext *s, TCGLabelQemuLdst *lb)
{
1261
    TCGReg argreg, datalo, datahi;
1262 1263
    TCGMemOpIdx oi = lb->oi;
    TCGMemOp opc = get_memop(oi);
1264
    void *func;
1265

1266
    reloc_pc24(lb->label_ptr[0], s->code_ptr);
1267 1268 1269 1270 1271 1272 1273

    argreg = tcg_out_arg_reg32(s, TCG_REG_R0, TCG_AREG0);
    if (TARGET_LONG_BITS == 64) {
        argreg = tcg_out_arg_reg64(s, argreg, lb->addrlo_reg, lb->addrhi_reg);
    } else {
        argreg = tcg_out_arg_reg32(s, argreg, lb->addrlo_reg);
    }
1274
    argreg = tcg_out_arg_imm32(s, argreg, oi);
1275 1276 1277 1278 1279 1280
    argreg = tcg_out_arg_reg32(s, argreg, TCG_REG_R14);

    /* For armv6 we can use the canonical unsigned helpers and minimize
       icache usage.  For pre-armv6, use the signed helpers since we do
       not have a single insn sign-extend.  */
    if (use_armv6_instructions) {
1281
        func = qemu_ld_helpers[opc & (MO_BSWAP | MO_SIZE)];
1282
    } else {
1283
        func = qemu_ld_helpers[opc & (MO_BSWAP | MO_SSIZE)];
1284 1285
        if (opc & MO_SIGN) {
            opc = MO_UL;
1286 1287 1288
        }
    }
    tcg_out_call(s, func);
1289

1290 1291
    datalo = lb->datalo_reg;
    datahi = lb->datahi_reg;
1292
    switch (opc & MO_SSIZE) {
1293
    case MO_SB:
1294
        tcg_out_ext8s(s, COND_AL, datalo, TCG_REG_R0);
1295
        break;
1296
    case MO_SW:
1297
        tcg_out_ext16s(s, COND_AL, datalo, TCG_REG_R0);
1298 1299
        break;
    default:
1300
        tcg_out_mov_reg(s, COND_AL, datalo, TCG_REG_R0);
1301
        break;
1302
    case MO_Q:
1303 1304 1305 1306 1307 1308
        if (datalo != TCG_REG_R1) {
            tcg_out_mov_reg(s, COND_AL, datalo, TCG_REG_R0);
            tcg_out_mov_reg(s, COND_AL, datahi, TCG_REG_R1);
        } else if (datahi != TCG_REG_R0) {
            tcg_out_mov_reg(s, COND_AL, datahi, TCG_REG_R1);
            tcg_out_mov_reg(s, COND_AL, datalo, TCG_REG_R0);
1309 1310
        } else {
            tcg_out_mov_reg(s, COND_AL, TCG_REG_TMP, TCG_REG_R0);
1311 1312
            tcg_out_mov_reg(s, COND_AL, datahi, TCG_REG_R1);
            tcg_out_mov_reg(s, COND_AL, datalo, TCG_REG_TMP);
1313
        }
1314 1315 1316
        break;
    }

1317
    tcg_out_goto(s, COND_AL, lb->raddr);
1318 1319 1320 1321
}

static void tcg_out_qemu_st_slow_path(TCGContext *s, TCGLabelQemuLdst *lb)
{
1322
    TCGReg argreg, datalo, datahi;
1323 1324
    TCGMemOpIdx oi = lb->oi;
    TCGMemOp opc = get_memop(oi);
1325

1326
    reloc_pc24(lb->label_ptr[0], s->code_ptr);
1327 1328 1329 1330 1331 1332 1333 1334 1335

    argreg = TCG_REG_R0;
    argreg = tcg_out_arg_reg32(s, argreg, TCG_AREG0);
    if (TARGET_LONG_BITS == 64) {
        argreg = tcg_out_arg_reg64(s, argreg, lb->addrlo_reg, lb->addrhi_reg);
    } else {
        argreg = tcg_out_arg_reg32(s, argreg, lb->addrlo_reg);
    }

1336 1337
    datalo = lb->datalo_reg;
    datahi = lb->datahi_reg;
1338
    switch (opc & MO_SIZE) {
1339
    case MO_8:
1340
        argreg = tcg_out_arg_reg8(s, argreg, datalo);
1341
        break;
1342
    case MO_16:
1343
        argreg = tcg_out_arg_reg16(s, argreg, datalo);
1344
        break;
1345 1346
    case MO_32:
    default:
1347
        argreg = tcg_out_arg_reg32(s, argreg, datalo);
1348
        break;
1349
    case MO_64:
1350
        argreg = tcg_out_arg_reg64(s, argreg, datalo, datahi);
1351 1352 1353
        break;
    }

1354
    argreg = tcg_out_arg_imm32(s, argreg, oi);
1355
    argreg = tcg_out_arg_reg32(s, argreg, TCG_REG_R14);
1356

1357
    /* Tail-call to the helper, which will return to the fast path.  */
1358
    tcg_out_goto(s, COND_AL, qemu_st_helpers[opc & (MO_BSWAP | MO_SIZE)]);
1359
}
1360 1361
#endif /* SOFTMMU */

1362 1363 1364
static inline void tcg_out_qemu_ld_index(TCGContext *s, TCGMemOp opc,
                                         TCGReg datalo, TCGReg datahi,
                                         TCGReg addrlo, TCGReg addend)
1365
{
1366
    TCGMemOp bswap = opc & MO_BSWAP;
1367

1368 1369
    switch (opc & MO_SSIZE) {
    case MO_UB:
1370
        tcg_out_ld8_r(s, COND_AL, datalo, addrlo, addend);
B
balrog 已提交
1371
        break;
1372
    case MO_SB:
1373
        tcg_out_ld8s_r(s, COND_AL, datalo, addrlo, addend);
B
balrog 已提交
1374
        break;
1375
    case MO_UW:
1376
        tcg_out_ld16u_r(s, COND_AL, datalo, addrlo, addend);
1377
        if (bswap) {
1378
            tcg_out_bswap16(s, COND_AL, datalo, datalo);
1379
        }
B
balrog 已提交
1380
        break;
1381
    case MO_SW:
1382
        if (bswap) {
1383 1384
            tcg_out_ld16u_r(s, COND_AL, datalo, addrlo, addend);
            tcg_out_bswap16s(s, COND_AL, datalo, datalo);
1385
        } else {
1386
            tcg_out_ld16s_r(s, COND_AL, datalo, addrlo, addend);
1387
        }
B
balrog 已提交
1388
        break;
1389
    case MO_UL:
B
balrog 已提交
1390
    default:
1391
        tcg_out_ld32_r(s, COND_AL, datalo, addrlo, addend);
1392
        if (bswap) {
1393
            tcg_out_bswap32(s, COND_AL, datalo, datalo);
1394
        }
B
balrog 已提交
1395
        break;
1396
    case MO_Q:
1397
        {
1398 1399
            TCGReg dl = (bswap ? datahi : datalo);
            TCGReg dh = (bswap ? datalo : datahi);
1400

1401 1402 1403
            /* Avoid ldrd for user-only emulation, to handle unaligned.  */
            if (USING_SOFTMMU && use_armv6_instructions
                && (dl & 1) == 0 && dh == dl + 1) {
1404
                tcg_out_ldrd_r(s, COND_AL, dl, addrlo, addend);
1405
            } else if (dl != addend) {
1406
                tcg_out_ld32_rwb(s, COND_AL, dl, addend, addrlo);
1407 1408 1409
                tcg_out_ld32_12(s, COND_AL, dh, addend, 4);
            } else {
                tcg_out_dat_reg(s, COND_AL, ARITH_ADD, TCG_REG_TMP,
1410
                                addend, addrlo, SHIFT_IMM_LSL(0));
1411 1412 1413 1414 1415
                tcg_out_ld32_12(s, COND_AL, dl, TCG_REG_TMP, 0);
                tcg_out_ld32_12(s, COND_AL, dh, TCG_REG_TMP, 4);
            }
            if (bswap) {
                tcg_out_bswap32(s, COND_AL, dl, dl);
1416
                tcg_out_bswap32(s, COND_AL, dh, dh);
1417
            }
1418
        }
B
balrog 已提交
1419 1420
        break;
    }
1421
}
B
balrog 已提交
1422

1423 1424 1425 1426 1427
static inline void tcg_out_qemu_ld_direct(TCGContext *s, TCGMemOp opc,
                                          TCGReg datalo, TCGReg datahi,
                                          TCGReg addrlo)
{
    TCGMemOp bswap = opc & MO_BSWAP;
P
Paul Brook 已提交
1428

1429 1430
    switch (opc & MO_SSIZE) {
    case MO_UB:
1431
        tcg_out_ld8_12(s, COND_AL, datalo, addrlo, 0);
B
balrog 已提交
1432
        break;
1433
    case MO_SB:
1434
        tcg_out_ld8s_8(s, COND_AL, datalo, addrlo, 0);
B
balrog 已提交
1435
        break;
1436
    case MO_UW:
1437
        tcg_out_ld16u_8(s, COND_AL, datalo, addrlo, 0);
1438
        if (bswap) {
1439
            tcg_out_bswap16(s, COND_AL, datalo, datalo);
1440
        }
B
balrog 已提交
1441
        break;
1442
    case MO_SW:
1443
        if (bswap) {
1444 1445
            tcg_out_ld16u_8(s, COND_AL, datalo, addrlo, 0);
            tcg_out_bswap16s(s, COND_AL, datalo, datalo);
1446
        } else {
1447
            tcg_out_ld16s_8(s, COND_AL, datalo, addrlo, 0);
1448
        }
B
balrog 已提交
1449
        break;
1450
    case MO_UL:
B
balrog 已提交
1451
    default:
1452
        tcg_out_ld32_12(s, COND_AL, datalo, addrlo, 0);
1453
        if (bswap) {
1454
            tcg_out_bswap32(s, COND_AL, datalo, datalo);
1455
        }
B
balrog 已提交
1456
        break;
1457
    case MO_Q:
1458 1459 1460 1461
        {
            TCGReg dl = (bswap ? datahi : datalo);
            TCGReg dh = (bswap ? datalo : datahi);

1462 1463 1464
            /* Avoid ldrd for user-only emulation, to handle unaligned.  */
            if (USING_SOFTMMU && use_armv6_instructions
                && (dl & 1) == 0 && dh == dl + 1) {
1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476
                tcg_out_ldrd_8(s, COND_AL, dl, addrlo, 0);
            } else if (dl == addrlo) {
                tcg_out_ld32_12(s, COND_AL, dh, addrlo, bswap ? 0 : 4);
                tcg_out_ld32_12(s, COND_AL, dl, addrlo, bswap ? 4 : 0);
            } else {
                tcg_out_ld32_12(s, COND_AL, dl, addrlo, bswap ? 4 : 0);
                tcg_out_ld32_12(s, COND_AL, dh, addrlo, bswap ? 0 : 4);
            }
            if (bswap) {
                tcg_out_bswap32(s, COND_AL, dl, dl);
                tcg_out_bswap32(s, COND_AL, dh, dh);
            }
A
aurel32 已提交
1477
        }
B
balrog 已提交
1478 1479 1480 1481
        break;
    }
}

1482
static void tcg_out_qemu_ld(TCGContext *s, const TCGArg *args, bool is64)
B
balrog 已提交
1483
{
1484
    TCGReg addrlo, datalo, datahi, addrhi __attribute__((unused));
1485
    TCGMemOpIdx oi;
1486
    TCGMemOp opc;
B
balrog 已提交
1487
#ifdef CONFIG_SOFTMMU
1488
    int mem_index;
1489
    TCGReg addend;
1490
    tcg_insn_unit *label_ptr;
B
balrog 已提交
1491
#endif
1492

1493
    datalo = *args++;
1494
    datahi = (is64 ? *args++ : 0);
1495 1496
    addrlo = *args++;
    addrhi = (TARGET_LONG_BITS == 64 ? *args++ : 0);
1497 1498
    oi = *args++;
    opc = get_memop(oi);
B
balrog 已提交
1499

1500
#ifdef CONFIG_SOFTMMU
1501
    mem_index = get_mmuidx(oi);
1502 1503 1504 1505 1506 1507 1508 1509
    addend = tcg_out_tlb_read(s, addrlo, addrhi, opc & MO_SIZE, mem_index, 1);

    /* This a conditional BL only to load a pointer within this opcode into LR
       for the slow path.  We will not be using the value for a tail call.  */
    label_ptr = s->code_ptr;
    tcg_out_bl_noaddr(s, COND_NE);

    tcg_out_qemu_ld_index(s, opc, datalo, datahi, addrlo, addend);
B
balrog 已提交
1510

1511 1512
    add_qemu_ldst_label(s, true, oi, datalo, datahi, addrlo, addrhi,
                        s->code_ptr, label_ptr);
1513
#else /* !CONFIG_SOFTMMU */
1514 1515
    if (guest_base) {
        tcg_out_movi(s, TCG_TYPE_PTR, TCG_REG_TMP, guest_base);
1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529
        tcg_out_qemu_ld_index(s, opc, datalo, datahi, addrlo, TCG_REG_TMP);
    } else {
        tcg_out_qemu_ld_direct(s, opc, datalo, datahi, addrlo);
    }
#endif
}

static inline void tcg_out_qemu_st_index(TCGContext *s, int cond, TCGMemOp opc,
                                         TCGReg datalo, TCGReg datahi,
                                         TCGReg addrlo, TCGReg addend)
{
    TCGMemOp bswap = opc & MO_BSWAP;

    switch (opc & MO_SIZE) {
1530
    case MO_8:
1531
        tcg_out_st8_r(s, cond, datalo, addrlo, addend);
B
balrog 已提交
1532
        break;
1533
    case MO_16:
1534
        if (bswap) {
1535 1536
            tcg_out_bswap16st(s, cond, TCG_REG_R0, datalo);
            tcg_out_st16_r(s, cond, TCG_REG_R0, addrlo, addend);
1537
        } else {
1538
            tcg_out_st16_r(s, cond, datalo, addrlo, addend);
1539
        }
B
balrog 已提交
1540
        break;
1541
    case MO_32:
B
balrog 已提交
1542
    default:
1543
        if (bswap) {
1544 1545
            tcg_out_bswap32(s, cond, TCG_REG_R0, datalo);
            tcg_out_st32_r(s, cond, TCG_REG_R0, addrlo, addend);
1546
        } else {
1547
            tcg_out_st32_r(s, cond, datalo, addrlo, addend);
1548
        }
B
balrog 已提交
1549
        break;
1550
    case MO_64:
1551
        /* Avoid strd for user-only emulation, to handle unaligned.  */
1552
        if (bswap) {
1553 1554 1555 1556
            tcg_out_bswap32(s, cond, TCG_REG_R0, datahi);
            tcg_out_st32_rwb(s, cond, TCG_REG_R0, addend, addrlo);
            tcg_out_bswap32(s, cond, TCG_REG_R0, datalo);
            tcg_out_st32_12(s, cond, TCG_REG_R0, addend, 4);
1557
        } else if (USING_SOFTMMU && use_armv6_instructions
1558
                   && (datalo & 1) == 0 && datahi == datalo + 1) {
1559
            tcg_out_strd_r(s, cond, datalo, addrlo, addend);
1560
        } else {
1561 1562
            tcg_out_st32_rwb(s, cond, datalo, addend, addrlo);
            tcg_out_st32_12(s, cond, datahi, addend, 4);
1563
        }
B
balrog 已提交
1564 1565
        break;
    }
1566
}
B
balrog 已提交
1567

1568 1569 1570 1571 1572
static inline void tcg_out_qemu_st_direct(TCGContext *s, TCGMemOp opc,
                                          TCGReg datalo, TCGReg datahi,
                                          TCGReg addrlo)
{
    TCGMemOp bswap = opc & MO_BSWAP;
1573

1574
    switch (opc & MO_SIZE) {
1575
    case MO_8:
1576
        tcg_out_st8_12(s, COND_AL, datalo, addrlo, 0);
B
balrog 已提交
1577
        break;
1578
    case MO_16:
1579
        if (bswap) {
1580 1581
            tcg_out_bswap16st(s, COND_AL, TCG_REG_R0, datalo);
            tcg_out_st16_8(s, COND_AL, TCG_REG_R0, addrlo, 0);
1582
        } else {
1583
            tcg_out_st16_8(s, COND_AL, datalo, addrlo, 0);
1584
        }
B
balrog 已提交
1585
        break;
1586
    case MO_32:
B
balrog 已提交
1587
    default:
1588
        if (bswap) {
1589 1590
            tcg_out_bswap32(s, COND_AL, TCG_REG_R0, datalo);
            tcg_out_st32_12(s, COND_AL, TCG_REG_R0, addrlo, 0);
1591
        } else {
1592
            tcg_out_st32_12(s, COND_AL, datalo, addrlo, 0);
1593
        }
B
balrog 已提交
1594
        break;
1595
    case MO_64:
1596
        /* Avoid strd for user-only emulation, to handle unaligned.  */
1597
        if (bswap) {
1598 1599 1600 1601
            tcg_out_bswap32(s, COND_AL, TCG_REG_R0, datahi);
            tcg_out_st32_12(s, COND_AL, TCG_REG_R0, addrlo, 0);
            tcg_out_bswap32(s, COND_AL, TCG_REG_R0, datalo);
            tcg_out_st32_12(s, COND_AL, TCG_REG_R0, addrlo, 4);
1602
        } else if (USING_SOFTMMU && use_armv6_instructions
1603 1604
                   && (datalo & 1) == 0 && datahi == datalo + 1) {
            tcg_out_strd_8(s, COND_AL, datalo, addrlo, 0);
1605
        } else {
1606 1607
            tcg_out_st32_12(s, COND_AL, datalo, addrlo, 0);
            tcg_out_st32_12(s, COND_AL, datahi, addrlo, 4);
1608
        }
B
balrog 已提交
1609 1610
        break;
    }
1611 1612 1613 1614 1615
}

static void tcg_out_qemu_st(TCGContext *s, const TCGArg *args, bool is64)
{
    TCGReg addrlo, datalo, datahi, addrhi __attribute__((unused));
1616
    TCGMemOpIdx oi;
1617 1618 1619 1620
    TCGMemOp opc;
#ifdef CONFIG_SOFTMMU
    int mem_index;
    TCGReg addend;
1621
    tcg_insn_unit *label_ptr;
1622 1623 1624 1625 1626 1627
#endif

    datalo = *args++;
    datahi = (is64 ? *args++ : 0);
    addrlo = *args++;
    addrhi = (TARGET_LONG_BITS == 64 ? *args++ : 0);
1628 1629
    oi = *args++;
    opc = get_memop(oi);
1630 1631

#ifdef CONFIG_SOFTMMU
1632
    mem_index = get_mmuidx(oi);
1633 1634 1635 1636 1637 1638 1639 1640
    addend = tcg_out_tlb_read(s, addrlo, addrhi, opc & MO_SIZE, mem_index, 0);

    tcg_out_qemu_st_index(s, COND_EQ, opc, datalo, datahi, addrlo, addend);

    /* The conditional call must come last, as we're going to return here.  */
    label_ptr = s->code_ptr;
    tcg_out_bl_noaddr(s, COND_NE);

1641 1642
    add_qemu_ldst_label(s, false, oi, datalo, datahi, addrlo, addrhi,
                        s->code_ptr, label_ptr);
1643
#else /* !CONFIG_SOFTMMU */
1644 1645
    if (guest_base) {
        tcg_out_movi(s, TCG_TYPE_PTR, TCG_REG_TMP, guest_base);
1646 1647 1648 1649 1650
        tcg_out_qemu_st_index(s, COND_AL, opc, datalo,
                              datahi, addrlo, TCG_REG_TMP);
    } else {
        tcg_out_qemu_st_direct(s, opc, datalo, datahi, addrlo);
    }
B
balrog 已提交
1651 1652 1653
#endif
}

1654
static tcg_insn_unit *tb_ret_addr;
B
balrog 已提交
1655

1656
static inline void tcg_out_op(TCGContext *s, TCGOpcode opc,
B
balrog 已提交
1657 1658
                const TCGArg *args, const int *const_args)
{
1659
    TCGArg a0, a1, a2, a3, a4, a5;
B
balrog 已提交
1660 1661 1662 1663
    int c;

    switch (opc) {
    case INDEX_op_exit_tb:
1664 1665
        tcg_out_movi32(s, COND_AL, TCG_REG_R0, args[0]);
        tcg_out_goto(s, COND_AL, tb_ret_addr);
B
balrog 已提交
1666 1667 1668 1669
        break;
    case INDEX_op_goto_tb:
        if (s->tb_jmp_offset) {
            /* Direct jump method */
1670
            s->tb_jmp_offset[args[0]] = tcg_current_code_size(s);
1671
            tcg_out_b_noaddr(s, COND_AL);
B
balrog 已提交
1672 1673
        } else {
            /* Indirect jump method */
1674 1675 1676
            intptr_t ptr = (intptr_t)(s->tb_next + args[0]);
            tcg_out_movi32(s, COND_AL, TCG_REG_R0, ptr & ~0xfff);
            tcg_out_ld32_12(s, COND_AL, TCG_REG_PC, TCG_REG_R0, ptr & 0xfff);
B
balrog 已提交
1677
        }
1678
        s->tb_next_offset[args[0]] = tcg_current_code_size(s);
B
balrog 已提交
1679 1680
        break;
    case INDEX_op_br:
1681
        tcg_out_goto_label(s, COND_AL, arg_label(args[0]));
B
balrog 已提交
1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
        break;

    case INDEX_op_ld8u_i32:
        tcg_out_ld8u(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_ld8s_i32:
        tcg_out_ld8s(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_ld16u_i32:
        tcg_out_ld16u(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_ld16s_i32:
        tcg_out_ld16s(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_ld_i32:
        tcg_out_ld32u(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_st8_i32:
1700
        tcg_out_st8(s, COND_AL, args[0], args[1], args[2]);
B
balrog 已提交
1701 1702
        break;
    case INDEX_op_st16_i32:
1703
        tcg_out_st16(s, COND_AL, args[0], args[1], args[2]);
B
balrog 已提交
1704 1705 1706 1707 1708
        break;
    case INDEX_op_st_i32:
        tcg_out_st32(s, COND_AL, args[0], args[1], args[2]);
        break;

P
Peter Maydell 已提交
1709 1710 1711 1712
    case INDEX_op_movcond_i32:
        /* Constraints mean that v2 is always in the same register as dest,
         * so we only need to do "if condition passed, move v1 to dest".
         */
1713 1714 1715 1716
        tcg_out_dat_rIN(s, COND_AL, ARITH_CMP, ARITH_CMN, 0,
                        args[1], args[2], const_args[2]);
        tcg_out_dat_rIK(s, tcg_cond_to_arm_cond[args[5]], ARITH_MOV,
                        ARITH_MVN, args[0], 0, args[3], const_args[3]);
P
Peter Maydell 已提交
1717
        break;
B
balrog 已提交
1718
    case INDEX_op_add_i32:
1719 1720 1721
        tcg_out_dat_rIN(s, COND_AL, ARITH_ADD, ARITH_SUB,
                        args[0], args[1], args[2], const_args[2]);
        break;
B
balrog 已提交
1722
    case INDEX_op_sub_i32:
1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733
        if (const_args[1]) {
            if (const_args[2]) {
                tcg_out_movi32(s, COND_AL, args[0], args[1] - args[2]);
            } else {
                tcg_out_dat_rI(s, COND_AL, ARITH_RSB,
                               args[0], args[2], args[1], 1);
            }
        } else {
            tcg_out_dat_rIN(s, COND_AL, ARITH_SUB, ARITH_ADD,
                            args[0], args[1], args[2], const_args[2]);
        }
1734
        break;
B
balrog 已提交
1735
    case INDEX_op_and_i32:
1736 1737 1738
        tcg_out_dat_rIK(s, COND_AL, ARITH_AND, ARITH_BIC,
                        args[0], args[1], args[2], const_args[2]);
        break;
A
Aurelien Jarno 已提交
1739
    case INDEX_op_andc_i32:
1740 1741 1742
        tcg_out_dat_rIK(s, COND_AL, ARITH_BIC, ARITH_AND,
                        args[0], args[1], args[2], const_args[2]);
        break;
B
balrog 已提交
1743 1744 1745 1746 1747 1748 1749
    case INDEX_op_or_i32:
        c = ARITH_ORR;
        goto gen_arith;
    case INDEX_op_xor_i32:
        c = ARITH_EOR;
        /* Fall through.  */
    gen_arith:
1750
        tcg_out_dat_rI(s, COND_AL, c, args[0], args[1], args[2], const_args[2]);
B
balrog 已提交
1751 1752
        break;
    case INDEX_op_add2_i32:
1753 1754 1755
        a0 = args[0], a1 = args[1], a2 = args[2];
        a3 = args[3], a4 = args[4], a5 = args[5];
        if (a0 == a3 || (a0 == a5 && !const_args[5])) {
1756
            a0 = TCG_REG_TMP;
1757 1758 1759 1760 1761 1762
        }
        tcg_out_dat_rIN(s, COND_AL, ARITH_ADD | TO_CPSR, ARITH_SUB | TO_CPSR,
                        a0, a2, a4, const_args[4]);
        tcg_out_dat_rIK(s, COND_AL, ARITH_ADC, ARITH_SBC,
                        a1, a3, a5, const_args[5]);
        tcg_out_mov_reg(s, COND_AL, args[0], a0);
B
balrog 已提交
1763 1764
        break;
    case INDEX_op_sub2_i32:
1765 1766 1767
        a0 = args[0], a1 = args[1], a2 = args[2];
        a3 = args[3], a4 = args[4], a5 = args[5];
        if ((a0 == a3 && !const_args[3]) || (a0 == a5 && !const_args[5])) {
1768
            a0 = TCG_REG_TMP;
1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790
        }
        if (const_args[2]) {
            if (const_args[4]) {
                tcg_out_movi32(s, COND_AL, a0, a4);
                a4 = a0;
            }
            tcg_out_dat_rI(s, COND_AL, ARITH_RSB | TO_CPSR, a0, a4, a2, 1);
        } else {
            tcg_out_dat_rIN(s, COND_AL, ARITH_SUB | TO_CPSR,
                            ARITH_ADD | TO_CPSR, a0, a2, a4, const_args[4]);
        }
        if (const_args[3]) {
            if (const_args[5]) {
                tcg_out_movi32(s, COND_AL, a1, a5);
                a5 = a1;
            }
            tcg_out_dat_rI(s, COND_AL, ARITH_RSC, a1, a5, a3, 1);
        } else {
            tcg_out_dat_rIK(s, COND_AL, ARITH_SBC, ARITH_ADC,
                            a1, a3, a5, const_args[5]);
        }
        tcg_out_mov_reg(s, COND_AL, args[0], a0);
B
balrog 已提交
1791
        break;
B
balrog 已提交
1792 1793 1794
    case INDEX_op_neg_i32:
        tcg_out_dat_imm(s, COND_AL, ARITH_RSB, args[0], args[1], 0);
        break;
L
Laurent Desnogues 已提交
1795 1796 1797 1798
    case INDEX_op_not_i32:
        tcg_out_dat_reg(s, COND_AL,
                        ARITH_MVN, args[0], 0, args[1], SHIFT_IMM_LSL(0));
        break;
B
balrog 已提交
1799 1800 1801 1802 1803 1804
    case INDEX_op_mul_i32:
        tcg_out_mul32(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_mulu2_i32:
        tcg_out_umull32(s, COND_AL, args[0], args[1], args[2], args[3]);
        break;
R
Richard Henderson 已提交
1805 1806 1807
    case INDEX_op_muls2_i32:
        tcg_out_smull32(s, COND_AL, args[0], args[1], args[2], args[3]);
        break;
B
balrog 已提交
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819
    /* XXX: Perhaps args[2] & 0x1f is wrong */
    case INDEX_op_shl_i32:
        c = const_args[2] ?
                SHIFT_IMM_LSL(args[2] & 0x1f) : SHIFT_REG_LSL(args[2]);
        goto gen_shift32;
    case INDEX_op_shr_i32:
        c = const_args[2] ? (args[2] & 0x1f) ? SHIFT_IMM_LSR(args[2] & 0x1f) :
                SHIFT_IMM_LSL(0) : SHIFT_REG_LSR(args[2]);
        goto gen_shift32;
    case INDEX_op_sar_i32:
        c = const_args[2] ? (args[2] & 0x1f) ? SHIFT_IMM_ASR(args[2] & 0x1f) :
                SHIFT_IMM_LSL(0) : SHIFT_REG_ASR(args[2]);
A
Aurelien Jarno 已提交
1820 1821 1822 1823
        goto gen_shift32;
    case INDEX_op_rotr_i32:
        c = const_args[2] ? (args[2] & 0x1f) ? SHIFT_IMM_ROR(args[2] & 0x1f) :
                SHIFT_IMM_LSL(0) : SHIFT_REG_ROR(args[2]);
B
balrog 已提交
1824 1825 1826 1827 1828
        /* Fall through.  */
    gen_shift32:
        tcg_out_dat_reg(s, COND_AL, ARITH_MOV, args[0], 0, args[1], c);
        break;

A
Aurelien Jarno 已提交
1829 1830 1831 1832 1833 1834 1835
    case INDEX_op_rotl_i32:
        if (const_args[2]) {
            tcg_out_dat_reg(s, COND_AL, ARITH_MOV, args[0], 0, args[1],
                            ((0x20 - args[2]) & 0x1f) ?
                            SHIFT_IMM_ROR((0x20 - args[2]) & 0x1f) :
                            SHIFT_IMM_LSL(0));
        } else {
1836
            tcg_out_dat_imm(s, COND_AL, ARITH_RSB, TCG_REG_TMP, args[2], 0x20);
A
Aurelien Jarno 已提交
1837
            tcg_out_dat_reg(s, COND_AL, ARITH_MOV, args[0], 0, args[1],
1838
                            SHIFT_REG_ROR(TCG_REG_TMP));
A
Aurelien Jarno 已提交
1839 1840 1841
        }
        break;

B
balrog 已提交
1842
    case INDEX_op_brcond_i32:
1843
        tcg_out_dat_rIN(s, COND_AL, ARITH_CMP, ARITH_CMN, 0,
1844
                       args[0], args[1], const_args[1]);
1845 1846
        tcg_out_goto_label(s, tcg_cond_to_arm_cond[args[2]],
                           arg_label(args[3]));
B
balrog 已提交
1847 1848 1849 1850 1851 1852 1853 1854 1855 1856
        break;
    case INDEX_op_brcond2_i32:
        /* The resulting conditions are:
         * TCG_COND_EQ    -->  a0 == a2 && a1 == a3,
         * TCG_COND_NE    --> (a0 != a2 && a1 == a3) ||  a1 != a3,
         * TCG_COND_LT(U) --> (a0 <  a2 && a1 == a3) ||  a1 <  a3,
         * TCG_COND_GE(U) --> (a0 >= a2 && a1 == a3) || (a1 >= a3 && a1 != a3),
         * TCG_COND_LE(U) --> (a0 <= a2 && a1 == a3) || (a1 <= a3 && a1 != a3),
         * TCG_COND_GT(U) --> (a0 >  a2 && a1 == a3) ||  a1 >  a3,
         */
1857 1858 1859 1860
        tcg_out_dat_rIN(s, COND_AL, ARITH_CMP, ARITH_CMN, 0,
                        args[1], args[3], const_args[3]);
        tcg_out_dat_rIN(s, COND_EQ, ARITH_CMP, ARITH_CMN, 0,
                        args[0], args[2], const_args[2]);
1861 1862
        tcg_out_goto_label(s, tcg_cond_to_arm_cond[args[4]],
                           arg_label(args[5]));
B
balrog 已提交
1863
        break;
A
Aurelien Jarno 已提交
1864
    case INDEX_op_setcond_i32:
1865 1866
        tcg_out_dat_rIN(s, COND_AL, ARITH_CMP, ARITH_CMN, 0,
                        args[1], args[2], const_args[2]);
A
Aurelien Jarno 已提交
1867 1868 1869 1870 1871
        tcg_out_dat_imm(s, tcg_cond_to_arm_cond[args[3]],
                        ARITH_MOV, args[0], 0, 1);
        tcg_out_dat_imm(s, tcg_cond_to_arm_cond[tcg_invert_cond(args[3])],
                        ARITH_MOV, args[0], 0, 0);
        break;
A
Aurelien Jarno 已提交
1872 1873
    case INDEX_op_setcond2_i32:
        /* See brcond2_i32 comment */
1874 1875 1876 1877
        tcg_out_dat_rIN(s, COND_AL, ARITH_CMP, ARITH_CMN, 0,
                        args[2], args[4], const_args[4]);
        tcg_out_dat_rIN(s, COND_EQ, ARITH_CMP, ARITH_CMN, 0,
                        args[1], args[3], const_args[3]);
A
Aurelien Jarno 已提交
1878 1879 1880 1881
        tcg_out_dat_imm(s, tcg_cond_to_arm_cond[args[5]],
                        ARITH_MOV, args[0], 0, 1);
        tcg_out_dat_imm(s, tcg_cond_to_arm_cond[tcg_invert_cond(args[5])],
                        ARITH_MOV, args[0], 0, 0);
A
Andrzej Zaborowski 已提交
1882
        break;
B
balrog 已提交
1883

1884 1885
    case INDEX_op_qemu_ld_i32:
        tcg_out_qemu_ld(s, args, 0);
B
balrog 已提交
1886
        break;
1887 1888
    case INDEX_op_qemu_ld_i64:
        tcg_out_qemu_ld(s, args, 1);
B
balrog 已提交
1889
        break;
1890 1891
    case INDEX_op_qemu_st_i32:
        tcg_out_qemu_st(s, args, 0);
B
balrog 已提交
1892
        break;
1893 1894
    case INDEX_op_qemu_st_i64:
        tcg_out_qemu_st(s, args, 1);
B
balrog 已提交
1895 1896
        break;

A
Aurelien Jarno 已提交
1897 1898 1899 1900 1901 1902 1903
    case INDEX_op_bswap16_i32:
        tcg_out_bswap16(s, COND_AL, args[0], args[1]);
        break;
    case INDEX_op_bswap32_i32:
        tcg_out_bswap32(s, COND_AL, args[0], args[1]);
        break;

B
balrog 已提交
1904
    case INDEX_op_ext8s_i32:
A
Aurelien Jarno 已提交
1905
        tcg_out_ext8s(s, COND_AL, args[0], args[1]);
B
balrog 已提交
1906 1907
        break;
    case INDEX_op_ext16s_i32:
A
Aurelien Jarno 已提交
1908 1909 1910 1911
        tcg_out_ext16s(s, COND_AL, args[0], args[1]);
        break;
    case INDEX_op_ext16u_i32:
        tcg_out_ext16u(s, COND_AL, args[0], args[1]);
B
balrog 已提交
1912 1913
        break;

1914 1915 1916 1917 1918
    case INDEX_op_deposit_i32:
        tcg_out_deposit(s, COND_AL, args[0], args[2],
                        args[3], args[4], const_args[2]);
        break;

1919 1920 1921 1922 1923 1924 1925
    case INDEX_op_div_i32:
        tcg_out_sdiv(s, COND_AL, args[0], args[1], args[2]);
        break;
    case INDEX_op_divu_i32:
        tcg_out_udiv(s, COND_AL, args[0], args[1], args[2]);
        break;

1926 1927 1928
    case INDEX_op_mov_i32:  /* Always emitted via tcg_out_mov.  */
    case INDEX_op_movi_i32: /* Always emitted via tcg_out_movi.  */
    case INDEX_op_call:     /* Always emitted via tcg_out_call.  */
B
balrog 已提交
1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948
    default:
        tcg_abort();
    }
}

static const TCGTargetOpDef arm_op_defs[] = {
    { INDEX_op_exit_tb, { } },
    { INDEX_op_goto_tb, { } },
    { INDEX_op_br, { } },

    { INDEX_op_ld8u_i32, { "r", "r" } },
    { INDEX_op_ld8s_i32, { "r", "r" } },
    { INDEX_op_ld16u_i32, { "r", "r" } },
    { INDEX_op_ld16s_i32, { "r", "r" } },
    { INDEX_op_ld_i32, { "r", "r" } },
    { INDEX_op_st8_i32, { "r", "r" } },
    { INDEX_op_st16_i32, { "r", "r" } },
    { INDEX_op_st_i32, { "r", "r" } },

    /* TODO: "r", "r", "ri" */
1949
    { INDEX_op_add_i32, { "r", "r", "rIN" } },
1950
    { INDEX_op_sub_i32, { "r", "rI", "rIN" } },
B
balrog 已提交
1951 1952
    { INDEX_op_mul_i32, { "r", "r", "r" } },
    { INDEX_op_mulu2_i32, { "r", "r", "r", "r" } },
R
Richard Henderson 已提交
1953
    { INDEX_op_muls2_i32, { "r", "r", "r", "r" } },
1954 1955
    { INDEX_op_and_i32, { "r", "r", "rIK" } },
    { INDEX_op_andc_i32, { "r", "r", "rIK" } },
1956 1957
    { INDEX_op_or_i32, { "r", "r", "rI" } },
    { INDEX_op_xor_i32, { "r", "r", "rI" } },
B
balrog 已提交
1958
    { INDEX_op_neg_i32, { "r", "r" } },
L
Laurent Desnogues 已提交
1959
    { INDEX_op_not_i32, { "r", "r" } },
B
balrog 已提交
1960 1961 1962 1963

    { INDEX_op_shl_i32, { "r", "r", "ri" } },
    { INDEX_op_shr_i32, { "r", "r", "ri" } },
    { INDEX_op_sar_i32, { "r", "r", "ri" } },
A
Aurelien Jarno 已提交
1964 1965
    { INDEX_op_rotl_i32, { "r", "r", "ri" } },
    { INDEX_op_rotr_i32, { "r", "r", "ri" } },
B
balrog 已提交
1966

1967 1968 1969
    { INDEX_op_brcond_i32, { "r", "rIN" } },
    { INDEX_op_setcond_i32, { "r", "r", "rIN" } },
    { INDEX_op_movcond_i32, { "r", "r", "rIN", "rIK", "0" } },
B
balrog 已提交
1970

1971 1972
    { INDEX_op_add2_i32, { "r", "r", "r", "r", "rIN", "rIK" } },
    { INDEX_op_sub2_i32, { "r", "r", "rI", "rI", "rIN", "rIK" } },
1973 1974
    { INDEX_op_brcond2_i32, { "r", "r", "rIN", "rIN" } },
    { INDEX_op_setcond2_i32, { "r", "r", "r", "rIN", "rIN" } },
B
balrog 已提交
1975

1976
#if TARGET_LONG_BITS == 32
1977 1978 1979 1980
    { INDEX_op_qemu_ld_i32, { "r", "l" } },
    { INDEX_op_qemu_ld_i64, { "r", "r", "l" } },
    { INDEX_op_qemu_st_i32, { "s", "s" } },
    { INDEX_op_qemu_st_i64, { "s", "s", "s" } },
1981
#else
1982 1983 1984 1985
    { INDEX_op_qemu_ld_i32, { "r", "l", "l" } },
    { INDEX_op_qemu_ld_i64, { "r", "r", "l", "l" } },
    { INDEX_op_qemu_st_i32, { "s", "s", "s" } },
    { INDEX_op_qemu_st_i64, { "s", "s", "s", "s" } },
1986
#endif
B
balrog 已提交
1987

A
Aurelien Jarno 已提交
1988 1989 1990
    { INDEX_op_bswap16_i32, { "r", "r" } },
    { INDEX_op_bswap32_i32, { "r", "r" } },

B
balrog 已提交
1991 1992
    { INDEX_op_ext8s_i32, { "r", "r" } },
    { INDEX_op_ext16s_i32, { "r", "r" } },
A
Aurelien Jarno 已提交
1993
    { INDEX_op_ext16u_i32, { "r", "r" } },
B
balrog 已提交
1994

1995 1996
    { INDEX_op_deposit_i32, { "r", "0", "rZ" } },

1997 1998 1999
    { INDEX_op_div_i32, { "r", "r", "r" } },
    { INDEX_op_divu_i32, { "r", "r", "r" } },

B
balrog 已提交
2000 2001 2002
    { -1 },
};

2003
static void tcg_target_init(TCGContext *s)
B
balrog 已提交
2004
{
2005 2006
    /* Only probe for the platform and capabilities if we havn't already
       determined maximum values at compile time.  */
R
Richard Henderson 已提交
2007
#ifndef use_idiv_instructions
2008
    {
R
Richard Henderson 已提交
2009
        unsigned long hwcap = qemu_getauxval(AT_HWCAP);
2010 2011
        use_idiv_instructions = (hwcap & HWCAP_ARM_IDIVA) != 0;
    }
R
Richard Henderson 已提交
2012
#endif
2013
    if (__ARM_ARCH < 7) {
R
Richard Henderson 已提交
2014
        const char *pl = (const char *)qemu_getauxval(AT_PLATFORM);
2015 2016 2017 2018
        if (pl != NULL && pl[0] == 'v' && pl[1] >= '4' && pl[1] <= '9') {
            arm_arch = pl[1] - '0';
        }
    }
2019

2020
    tcg_regset_set32(tcg_target_available_regs[TCG_TYPE_I32], 0, 0xffff);
B
balrog 已提交
2021
    tcg_regset_set32(tcg_target_call_clobber_regs, 0,
2022 2023 2024 2025 2026 2027
                     (1 << TCG_REG_R0) |
                     (1 << TCG_REG_R1) |
                     (1 << TCG_REG_R2) |
                     (1 << TCG_REG_R3) |
                     (1 << TCG_REG_R12) |
                     (1 << TCG_REG_R14));
B
balrog 已提交
2028 2029 2030

    tcg_regset_clear(s->reserved_regs);
    tcg_regset_set_reg(s->reserved_regs, TCG_REG_CALL_STACK);
2031
    tcg_regset_set_reg(s->reserved_regs, TCG_REG_TMP);
2032
    tcg_regset_set_reg(s->reserved_regs, TCG_REG_PC);
B
balrog 已提交
2033 2034 2035 2036

    tcg_add_target_add_op_defs(arm_op_defs);
}

2037
static inline void tcg_out_ld(TCGContext *s, TCGType type, TCGReg arg,
2038
                              TCGReg arg1, intptr_t arg2)
B
balrog 已提交
2039 2040 2041 2042
{
    tcg_out_ld32u(s, COND_AL, arg, arg1, arg2);
}

2043
static inline void tcg_out_st(TCGContext *s, TCGType type, TCGReg arg,
2044
                              TCGReg arg1, intptr_t arg2)
B
balrog 已提交
2045 2046 2047 2048
{
    tcg_out_st32(s, COND_AL, arg, arg1, arg2);
}

2049 2050
static inline void tcg_out_mov(TCGContext *s, TCGType type,
                               TCGReg ret, TCGReg arg)
B
balrog 已提交
2051 2052 2053 2054 2055
{
    tcg_out_dat_reg(s, COND_AL, ARITH_MOV, ret, 0, arg, SHIFT_IMM_LSL(0));
}

static inline void tcg_out_movi(TCGContext *s, TCGType type,
2056
                                TCGReg ret, tcg_target_long arg)
B
balrog 已提交
2057 2058 2059 2060
{
    tcg_out_movi32(s, COND_AL, ret, arg);
}

2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072
/* Compute frame size via macros, to share between tcg_target_qemu_prologue
   and tcg_register_jit.  */

#define PUSH_SIZE  ((11 - 4 + 1 + 1) * sizeof(tcg_target_long))

#define FRAME_SIZE \
    ((PUSH_SIZE \
      + TCG_STATIC_CALL_ARGS_SIZE \
      + CPU_TEMP_BUF_NLONGS * sizeof(long) \
      + TCG_TARGET_STACK_ALIGN - 1) \
     & -TCG_TARGET_STACK_ALIGN)

2073
static void tcg_target_qemu_prologue(TCGContext *s)
B
balrog 已提交
2074
{
2075
    int stack_addend;
2076 2077 2078 2079

    /* Calling convention requires us to save r4-r11 and lr.  */
    /* stmdb sp!, { r4 - r11, lr } */
    tcg_out32(s, (COND_AL << 28) | 0x092d4ff0);
B
Blue Swirl 已提交
2080

2081 2082
    /* Reserve callee argument and tcg temp space.  */
    stack_addend = FRAME_SIZE - PUSH_SIZE;
2083 2084

    tcg_out_dat_rI(s, COND_AL, ARITH_SUB, TCG_REG_CALL_STACK,
2085
                   TCG_REG_CALL_STACK, stack_addend, 1);
2086 2087
    tcg_set_frame(s, TCG_REG_CALL_STACK, TCG_STATIC_CALL_ARGS_SIZE,
                  CPU_TEMP_BUF_NLONGS * sizeof(long));
2088

B
Blue Swirl 已提交
2089
    tcg_out_mov(s, TCG_TYPE_PTR, TCG_AREG0, tcg_target_call_iarg_regs[0]);
B
balrog 已提交
2090

B
Blue Swirl 已提交
2091
    tcg_out_bx(s, COND_AL, tcg_target_call_iarg_regs[1]);
B
balrog 已提交
2092 2093
    tb_ret_addr = s->code_ptr;

2094 2095
    /* Epilogue.  We branch here via tb_ret_addr.  */
    tcg_out_dat_rI(s, COND_AL, ARITH_ADD, TCG_REG_CALL_STACK,
2096
                   TCG_REG_CALL_STACK, stack_addend, 1);
2097 2098 2099

    /* ldmia sp!, { r4 - r11, pc } */
    tcg_out32(s, (COND_AL << 28) | 0x08bd8ff0);
B
balrog 已提交
2100
}
2101 2102

typedef struct {
2103
    DebugFrameHeader h;
2104 2105 2106 2107 2108 2109 2110 2111 2112
    uint8_t fde_def_cfa[4];
    uint8_t fde_reg_ofs[18];
} DebugFrame;

#define ELF_HOST_MACHINE EM_ARM

/* We're expecting a 2 byte uleb128 encoded value.  */
QEMU_BUILD_BUG_ON(FRAME_SIZE >= (1 << 14));

2113 2114 2115 2116 2117 2118 2119
static const DebugFrame debug_frame = {
    .h.cie.len = sizeof(DebugFrameCIE)-4, /* length after .len member */
    .h.cie.id = -1,
    .h.cie.version = 1,
    .h.cie.code_align = 1,
    .h.cie.data_align = 0x7c,             /* sleb128 -4 */
    .h.cie.return_column = 14,
2120 2121

    /* Total FDE size does not include the "len" member.  */
2122
    .h.fde.len = sizeof(DebugFrame) - offsetof(DebugFrame, h.fde.cie_offset),
2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146

    .fde_def_cfa = {
        12, 13,                         /* DW_CFA_def_cfa sp, ... */
        (FRAME_SIZE & 0x7f) | 0x80,     /* ... uleb128 FRAME_SIZE */
        (FRAME_SIZE >> 7)
    },
    .fde_reg_ofs = {
        /* The following must match the stmdb in the prologue.  */
        0x8e, 1,                        /* DW_CFA_offset, lr, -4 */
        0x8b, 2,                        /* DW_CFA_offset, r11, -8 */
        0x8a, 3,                        /* DW_CFA_offset, r10, -12 */
        0x89, 4,                        /* DW_CFA_offset, r9, -16 */
        0x88, 5,                        /* DW_CFA_offset, r8, -20 */
        0x87, 6,                        /* DW_CFA_offset, r7, -24 */
        0x86, 7,                        /* DW_CFA_offset, r6, -28 */
        0x85, 8,                        /* DW_CFA_offset, r5, -32 */
        0x84, 9,                        /* DW_CFA_offset, r4, -36 */
    }
};

void tcg_register_jit(void *buf, size_t buf_size)
{
    tcg_register_jit_int(buf, buf_size, &debug_frame, sizeof(debug_frame));
}