~ubuntu-branches/ubuntu/vivid/qemu/vivid

« back to all changes in this revision

Viewing changes to .pc/ubuntu/arm64/0146-target-arm-A64-Add-SIMD-simple-64-bit-insns-from-sca.patch/target-arm/translate-a64.c

  • Committer: Package Import Robot
  • Author(s): Serge Hallyn
  • Date: 2014-02-25 22:31:43 UTC
  • mfrom: (1.8.5)
  • Revision ID: package-import@ubuntu.com-20140225223143-odhqxfc60wxrjl15
Tags: 2.0.0~rc1+dfsg-0ubuntu1
* Merge 2.0.0-rc1
* debian/rules: consolidate ppc filter entries.
* Move qemu-system-arch64 into qemu-system-arm
* debian/patches/define-trusty-machine-type.patch: define a trusty machine
  type, currently the same as pc-i440fx-2.0, to put is in a better position
  to enable live migrations from trusty onward.  (LP: #1294823)
* debian/control: build-dep on libfdt >= 1.4.0  (LP: #1295072)
* Merge latest upstream git to commit dc9528f
* Debian/rules:
  - remove -enable-uname-release=2.6.32
  - don't make the aarch64 target Ubuntu-specific.
* Remove patches which are now upstream:
  - fix-smb-security-share.patch
  - slirp-smb-redirect-port-445-too.patch 
  - linux-user-Implement-sendmmsg-syscall.patch (better version is upstream)
  - signal-added-a-wrapper-for-sigprocmask-function.patch
  - ubuntu/signal-sigsegv-protection-on-do_sigprocmask.patch
  - ubuntu/Don-t-block-SIGSEGV-at-more-places.patch
  - ubuntu/ppc-force-cpu-threads-count-to-be-power-of-2.patch
* add link for /usr/share/qemu/bios-256k.bin
* Remove all linaro patches.
* Remove all arm64/ patches.  Many but not all are upstream.
* Remove CVE-2013-4377.patch which is upstream.
* debian/control-in: don't make qemu-system-aarch64 ubuntu-specific

Show diffs side-by-side

added added

removed removed

Lines of Context:
1
 
/*
2
 
 *  AArch64 translation
3
 
 *
4
 
 *  Copyright (c) 2013 Alexander Graf <agraf@suse.de>
5
 
 *
6
 
 * This library is free software; you can redistribute it and/or
7
 
 * modify it under the terms of the GNU Lesser General Public
8
 
 * License as published by the Free Software Foundation; either
9
 
 * version 2 of the License, or (at your option) any later version.
10
 
 *
11
 
 * This library is distributed in the hope that it will be useful,
12
 
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13
 
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14
 
 * Lesser General Public License for more details.
15
 
 *
16
 
 * You should have received a copy of the GNU Lesser General Public
17
 
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18
 
 */
19
 
#include <stdarg.h>
20
 
#include <stdlib.h>
21
 
#include <stdio.h>
22
 
#include <string.h>
23
 
#include <inttypes.h>
24
 
 
25
 
#include "cpu.h"
26
 
#include "tcg-op.h"
27
 
#include "qemu/log.h"
28
 
#include "translate.h"
29
 
#include "qemu/host-utils.h"
30
 
 
31
 
#include "exec/gen-icount.h"
32
 
 
33
 
#include "helper.h"
34
 
#define GEN_HELPER 1
35
 
#include "helper.h"
36
 
 
37
 
static TCGv_i64 cpu_X[32];
38
 
static TCGv_i64 cpu_pc;
39
 
static TCGv_i32 cpu_NF, cpu_ZF, cpu_CF, cpu_VF;
40
 
 
41
 
/* Load/store exclusive handling */
42
 
static TCGv_i64 cpu_exclusive_addr;
43
 
static TCGv_i64 cpu_exclusive_val;
44
 
static TCGv_i64 cpu_exclusive_high;
45
 
#ifdef CONFIG_USER_ONLY
46
 
static TCGv_i64 cpu_exclusive_test;
47
 
static TCGv_i32 cpu_exclusive_info;
48
 
#endif
49
 
 
50
 
static const char *regnames[] = {
51
 
    "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",
52
 
    "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
53
 
    "x16", "x17", "x18", "x19", "x20", "x21", "x22", "x23",
54
 
    "x24", "x25", "x26", "x27", "x28", "x29", "lr", "sp"
55
 
};
56
 
 
57
 
enum a64_shift_type {
58
 
    A64_SHIFT_TYPE_LSL = 0,
59
 
    A64_SHIFT_TYPE_LSR = 1,
60
 
    A64_SHIFT_TYPE_ASR = 2,
61
 
    A64_SHIFT_TYPE_ROR = 3
62
 
};
63
 
 
64
 
/* Table based decoder typedefs - used when the relevant bits for decode
65
 
 * are too awkwardly scattered across the instruction (eg SIMD).
66
 
 */
67
 
typedef void AArch64DecodeFn(DisasContext *s, uint32_t insn);
68
 
 
69
 
typedef struct AArch64DecodeTable {
70
 
    uint32_t pattern;
71
 
    uint32_t mask;
72
 
    AArch64DecodeFn *disas_fn;
73
 
} AArch64DecodeTable;
74
 
 
75
 
/* Function prototype for gen_ functions for calling Neon helpers */
76
 
typedef void NeonGenTwoOpFn(TCGv_i32, TCGv_i32, TCGv_i32);
77
 
typedef void NeonGenTwoOpEnvFn(TCGv_i32, TCGv_ptr, TCGv_i32, TCGv_i32);
78
 
 
79
 
/* initialize TCG globals.  */
80
 
void a64_translate_init(void)
81
 
{
82
 
    int i;
83
 
 
84
 
    cpu_pc = tcg_global_mem_new_i64(TCG_AREG0,
85
 
                                    offsetof(CPUARMState, pc),
86
 
                                    "pc");
87
 
    for (i = 0; i < 32; i++) {
88
 
        cpu_X[i] = tcg_global_mem_new_i64(TCG_AREG0,
89
 
                                          offsetof(CPUARMState, xregs[i]),
90
 
                                          regnames[i]);
91
 
    }
92
 
 
93
 
    cpu_NF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, NF), "NF");
94
 
    cpu_ZF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, ZF), "ZF");
95
 
    cpu_CF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, CF), "CF");
96
 
    cpu_VF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, VF), "VF");
97
 
 
98
 
    cpu_exclusive_addr = tcg_global_mem_new_i64(TCG_AREG0,
99
 
        offsetof(CPUARMState, exclusive_addr), "exclusive_addr");
100
 
    cpu_exclusive_val = tcg_global_mem_new_i64(TCG_AREG0,
101
 
        offsetof(CPUARMState, exclusive_val), "exclusive_val");
102
 
    cpu_exclusive_high = tcg_global_mem_new_i64(TCG_AREG0,
103
 
        offsetof(CPUARMState, exclusive_high), "exclusive_high");
104
 
#ifdef CONFIG_USER_ONLY
105
 
    cpu_exclusive_test = tcg_global_mem_new_i64(TCG_AREG0,
106
 
        offsetof(CPUARMState, exclusive_test), "exclusive_test");
107
 
    cpu_exclusive_info = tcg_global_mem_new_i32(TCG_AREG0,
108
 
        offsetof(CPUARMState, exclusive_info), "exclusive_info");
109
 
#endif
110
 
}
111
 
 
112
 
void aarch64_cpu_dump_state(CPUState *cs, FILE *f,
113
 
                            fprintf_function cpu_fprintf, int flags)
114
 
{
115
 
    ARMCPU *cpu = ARM_CPU(cs);
116
 
    CPUARMState *env = &cpu->env;
117
 
    uint32_t psr = pstate_read(env);
118
 
    int i;
119
 
 
120
 
    cpu_fprintf(f, "PC=%016"PRIx64"  SP=%016"PRIx64"\n",
121
 
            env->pc, env->xregs[31]);
122
 
    for (i = 0; i < 31; i++) {
123
 
        cpu_fprintf(f, "X%02d=%016"PRIx64, i, env->xregs[i]);
124
 
        if ((i % 4) == 3) {
125
 
            cpu_fprintf(f, "\n");
126
 
        } else {
127
 
            cpu_fprintf(f, " ");
128
 
        }
129
 
    }
130
 
    cpu_fprintf(f, "PSTATE=%08x (flags %c%c%c%c)\n",
131
 
                psr,
132
 
                psr & PSTATE_N ? 'N' : '-',
133
 
                psr & PSTATE_Z ? 'Z' : '-',
134
 
                psr & PSTATE_C ? 'C' : '-',
135
 
                psr & PSTATE_V ? 'V' : '-');
136
 
    cpu_fprintf(f, "\n");
137
 
 
138
 
    if (flags & CPU_DUMP_FPU) {
139
 
        int numvfpregs = 32;
140
 
        for (i = 0; i < numvfpregs; i += 2) {
141
 
            uint64_t vlo = float64_val(env->vfp.regs[i * 2]);
142
 
            uint64_t vhi = float64_val(env->vfp.regs[(i * 2) + 1]);
143
 
            cpu_fprintf(f, "q%02d=%016" PRIx64 ":%016" PRIx64 " ",
144
 
                        i, vhi, vlo);
145
 
            vlo = float64_val(env->vfp.regs[(i + 1) * 2]);
146
 
            vhi = float64_val(env->vfp.regs[((i + 1) * 2) + 1]);
147
 
            cpu_fprintf(f, "q%02d=%016" PRIx64 ":%016" PRIx64 "\n",
148
 
                        i + 1, vhi, vlo);
149
 
        }
150
 
        cpu_fprintf(f, "FPCR: %08x  FPSR: %08x\n",
151
 
                    vfp_get_fpcr(env), vfp_get_fpsr(env));
152
 
    }
153
 
}
154
 
 
155
 
static int get_mem_index(DisasContext *s)
156
 
{
157
 
#ifdef CONFIG_USER_ONLY
158
 
    return 1;
159
 
#else
160
 
    return s->user;
161
 
#endif
162
 
}
163
 
 
164
 
void gen_a64_set_pc_im(uint64_t val)
165
 
{
166
 
    tcg_gen_movi_i64(cpu_pc, val);
167
 
}
168
 
 
169
 
static void gen_exception(int excp)
170
 
{
171
 
    TCGv_i32 tmp = tcg_temp_new_i32();
172
 
    tcg_gen_movi_i32(tmp, excp);
173
 
    gen_helper_exception(cpu_env, tmp);
174
 
    tcg_temp_free_i32(tmp);
175
 
}
176
 
 
177
 
static void gen_exception_insn(DisasContext *s, int offset, int excp)
178
 
{
179
 
    gen_a64_set_pc_im(s->pc - offset);
180
 
    gen_exception(excp);
181
 
    s->is_jmp = DISAS_EXC;
182
 
}
183
 
 
184
 
static inline bool use_goto_tb(DisasContext *s, int n, uint64_t dest)
185
 
{
186
 
    /* No direct tb linking with singlestep or deterministic io */
187
 
    if (s->singlestep_enabled || (s->tb->cflags & CF_LAST_IO)) {
188
 
        return false;
189
 
    }
190
 
 
191
 
    /* Only link tbs from inside the same guest page */
192
 
    if ((s->tb->pc & TARGET_PAGE_MASK) != (dest & TARGET_PAGE_MASK)) {
193
 
        return false;
194
 
    }
195
 
 
196
 
    return true;
197
 
}
198
 
 
199
 
static inline void gen_goto_tb(DisasContext *s, int n, uint64_t dest)
200
 
{
201
 
    TranslationBlock *tb;
202
 
 
203
 
    tb = s->tb;
204
 
    if (use_goto_tb(s, n, dest)) {
205
 
        tcg_gen_goto_tb(n);
206
 
        gen_a64_set_pc_im(dest);
207
 
        tcg_gen_exit_tb((tcg_target_long)tb + n);
208
 
        s->is_jmp = DISAS_TB_JUMP;
209
 
    } else {
210
 
        gen_a64_set_pc_im(dest);
211
 
        if (s->singlestep_enabled) {
212
 
            gen_exception(EXCP_DEBUG);
213
 
        }
214
 
        tcg_gen_exit_tb(0);
215
 
        s->is_jmp = DISAS_JUMP;
216
 
    }
217
 
}
218
 
 
219
 
static void unallocated_encoding(DisasContext *s)
220
 
{
221
 
    gen_exception_insn(s, 4, EXCP_UDEF);
222
 
}
223
 
 
224
 
#define unsupported_encoding(s, insn)                                    \
225
 
    do {                                                                 \
226
 
        qemu_log_mask(LOG_UNIMP,                                         \
227
 
                      "%s:%d: unsupported instruction encoding 0x%08x "  \
228
 
                      "at pc=%016" PRIx64 "\n",                          \
229
 
                      __FILE__, __LINE__, insn, s->pc - 4);              \
230
 
        unallocated_encoding(s);                                         \
231
 
    } while (0);
232
 
 
233
 
static void init_tmp_a64_array(DisasContext *s)
234
 
{
235
 
#ifdef CONFIG_DEBUG_TCG
236
 
    int i;
237
 
    for (i = 0; i < ARRAY_SIZE(s->tmp_a64); i++) {
238
 
        TCGV_UNUSED_I64(s->tmp_a64[i]);
239
 
    }
240
 
#endif
241
 
    s->tmp_a64_count = 0;
242
 
}
243
 
 
244
 
static void free_tmp_a64(DisasContext *s)
245
 
{
246
 
    int i;
247
 
    for (i = 0; i < s->tmp_a64_count; i++) {
248
 
        tcg_temp_free_i64(s->tmp_a64[i]);
249
 
    }
250
 
    init_tmp_a64_array(s);
251
 
}
252
 
 
253
 
static TCGv_i64 new_tmp_a64(DisasContext *s)
254
 
{
255
 
    assert(s->tmp_a64_count < TMP_A64_MAX);
256
 
    return s->tmp_a64[s->tmp_a64_count++] = tcg_temp_new_i64();
257
 
}
258
 
 
259
 
static TCGv_i64 new_tmp_a64_zero(DisasContext *s)
260
 
{
261
 
    TCGv_i64 t = new_tmp_a64(s);
262
 
    tcg_gen_movi_i64(t, 0);
263
 
    return t;
264
 
}
265
 
 
266
 
/*
267
 
 * Register access functions
268
 
 *
269
 
 * These functions are used for directly accessing a register in where
270
 
 * changes to the final register value are likely to be made. If you
271
 
 * need to use a register for temporary calculation (e.g. index type
272
 
 * operations) use the read_* form.
273
 
 *
274
 
 * B1.2.1 Register mappings
275
 
 *
276
 
 * In instruction register encoding 31 can refer to ZR (zero register) or
277
 
 * the SP (stack pointer) depending on context. In QEMU's case we map SP
278
 
 * to cpu_X[31] and ZR accesses to a temporary which can be discarded.
279
 
 * This is the point of the _sp forms.
280
 
 */
281
 
static TCGv_i64 cpu_reg(DisasContext *s, int reg)
282
 
{
283
 
    if (reg == 31) {
284
 
        return new_tmp_a64_zero(s);
285
 
    } else {
286
 
        return cpu_X[reg];
287
 
    }
288
 
}
289
 
 
290
 
/* register access for when 31 == SP */
291
 
static TCGv_i64 cpu_reg_sp(DisasContext *s, int reg)
292
 
{
293
 
    return cpu_X[reg];
294
 
}
295
 
 
296
 
/* read a cpu register in 32bit/64bit mode. Returns a TCGv_i64
297
 
 * representing the register contents. This TCGv is an auto-freed
298
 
 * temporary so it need not be explicitly freed, and may be modified.
299
 
 */
300
 
static TCGv_i64 read_cpu_reg(DisasContext *s, int reg, int sf)
301
 
{
302
 
    TCGv_i64 v = new_tmp_a64(s);
303
 
    if (reg != 31) {
304
 
        if (sf) {
305
 
            tcg_gen_mov_i64(v, cpu_X[reg]);
306
 
        } else {
307
 
            tcg_gen_ext32u_i64(v, cpu_X[reg]);
308
 
        }
309
 
    } else {
310
 
        tcg_gen_movi_i64(v, 0);
311
 
    }
312
 
    return v;
313
 
}
314
 
 
315
 
static TCGv_i64 read_cpu_reg_sp(DisasContext *s, int reg, int sf)
316
 
{
317
 
    TCGv_i64 v = new_tmp_a64(s);
318
 
    if (sf) {
319
 
        tcg_gen_mov_i64(v, cpu_X[reg]);
320
 
    } else {
321
 
        tcg_gen_ext32u_i64(v, cpu_X[reg]);
322
 
    }
323
 
    return v;
324
 
}
325
 
 
326
 
/* Return the offset into CPUARMState of an element of specified
327
 
 * size, 'element' places in from the least significant end of
328
 
 * the FP/vector register Qn.
329
 
 */
330
 
static inline int vec_reg_offset(int regno, int element, TCGMemOp size)
331
 
{
332
 
    int offs = offsetof(CPUARMState, vfp.regs[regno * 2]);
333
 
#ifdef HOST_WORDS_BIGENDIAN
334
 
    /* This is complicated slightly because vfp.regs[2n] is
335
 
     * still the low half and  vfp.regs[2n+1] the high half
336
 
     * of the 128 bit vector, even on big endian systems.
337
 
     * Calculate the offset assuming a fully bigendian 128 bits,
338
 
     * then XOR to account for the order of the two 64 bit halves.
339
 
     */
340
 
    offs += (16 - ((element + 1) * (1 << size)));
341
 
    offs ^= 8;
342
 
#else
343
 
    offs += element * (1 << size);
344
 
#endif
345
 
    return offs;
346
 
}
347
 
 
348
 
/* Return the offset into CPUARMState of a slice (from
349
 
 * the least significant end) of FP register Qn (ie
350
 
 * Dn, Sn, Hn or Bn).
351
 
 * (Note that this is not the same mapping as for A32; see cpu.h)
352
 
 */
353
 
static inline int fp_reg_offset(int regno, TCGMemOp size)
354
 
{
355
 
    int offs = offsetof(CPUARMState, vfp.regs[regno * 2]);
356
 
#ifdef HOST_WORDS_BIGENDIAN
357
 
    offs += (8 - (1 << size));
358
 
#endif
359
 
    return offs;
360
 
}
361
 
 
362
 
/* Offset of the high half of the 128 bit vector Qn */
363
 
static inline int fp_reg_hi_offset(int regno)
364
 
{
365
 
    return offsetof(CPUARMState, vfp.regs[regno * 2 + 1]);
366
 
}
367
 
 
368
 
/* Convenience accessors for reading and writing single and double
369
 
 * FP registers. Writing clears the upper parts of the associated
370
 
 * 128 bit vector register, as required by the architecture.
371
 
 * Note that unlike the GP register accessors, the values returned
372
 
 * by the read functions must be manually freed.
373
 
 */
374
 
static TCGv_i64 read_fp_dreg(DisasContext *s, int reg)
375
 
{
376
 
    TCGv_i64 v = tcg_temp_new_i64();
377
 
 
378
 
    tcg_gen_ld_i64(v, cpu_env, fp_reg_offset(reg, MO_64));
379
 
    return v;
380
 
}
381
 
 
382
 
static TCGv_i32 read_fp_sreg(DisasContext *s, int reg)
383
 
{
384
 
    TCGv_i32 v = tcg_temp_new_i32();
385
 
 
386
 
    tcg_gen_ld_i32(v, cpu_env, fp_reg_offset(reg, MO_32));
387
 
    return v;
388
 
}
389
 
 
390
 
static void write_fp_dreg(DisasContext *s, int reg, TCGv_i64 v)
391
 
{
392
 
    TCGv_i64 tcg_zero = tcg_const_i64(0);
393
 
 
394
 
    tcg_gen_st_i64(v, cpu_env, fp_reg_offset(reg, MO_64));
395
 
    tcg_gen_st_i64(tcg_zero, cpu_env, fp_reg_hi_offset(reg));
396
 
    tcg_temp_free_i64(tcg_zero);
397
 
}
398
 
 
399
 
static void write_fp_sreg(DisasContext *s, int reg, TCGv_i32 v)
400
 
{
401
 
    TCGv_i64 tmp = tcg_temp_new_i64();
402
 
 
403
 
    tcg_gen_extu_i32_i64(tmp, v);
404
 
    write_fp_dreg(s, reg, tmp);
405
 
    tcg_temp_free_i64(tmp);
406
 
}
407
 
 
408
 
static TCGv_ptr get_fpstatus_ptr(void)
409
 
{
410
 
    TCGv_ptr statusptr = tcg_temp_new_ptr();
411
 
    int offset;
412
 
 
413
 
    /* In A64 all instructions (both FP and Neon) use the FPCR;
414
 
     * there is no equivalent of the A32 Neon "standard FPSCR value"
415
 
     * and all operations use vfp.fp_status.
416
 
     */
417
 
    offset = offsetof(CPUARMState, vfp.fp_status);
418
 
    tcg_gen_addi_ptr(statusptr, cpu_env, offset);
419
 
    return statusptr;
420
 
}
421
 
 
422
 
/* Set ZF and NF based on a 64 bit result. This is alas fiddlier
423
 
 * than the 32 bit equivalent.
424
 
 */
425
 
static inline void gen_set_NZ64(TCGv_i64 result)
426
 
{
427
 
    TCGv_i64 flag = tcg_temp_new_i64();
428
 
 
429
 
    tcg_gen_setcondi_i64(TCG_COND_NE, flag, result, 0);
430
 
    tcg_gen_trunc_i64_i32(cpu_ZF, flag);
431
 
    tcg_gen_shri_i64(flag, result, 32);
432
 
    tcg_gen_trunc_i64_i32(cpu_NF, flag);
433
 
    tcg_temp_free_i64(flag);
434
 
}
435
 
 
436
 
/* Set NZCV as for a logical operation: NZ as per result, CV cleared. */
437
 
static inline void gen_logic_CC(int sf, TCGv_i64 result)
438
 
{
439
 
    if (sf) {
440
 
        gen_set_NZ64(result);
441
 
    } else {
442
 
        tcg_gen_trunc_i64_i32(cpu_ZF, result);
443
 
        tcg_gen_trunc_i64_i32(cpu_NF, result);
444
 
    }
445
 
    tcg_gen_movi_i32(cpu_CF, 0);
446
 
    tcg_gen_movi_i32(cpu_VF, 0);
447
 
}
448
 
 
449
 
/* dest = T0 + T1; compute C, N, V and Z flags */
450
 
static void gen_add_CC(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
451
 
{
452
 
    if (sf) {
453
 
        TCGv_i64 result, flag, tmp;
454
 
        result = tcg_temp_new_i64();
455
 
        flag = tcg_temp_new_i64();
456
 
        tmp = tcg_temp_new_i64();
457
 
 
458
 
        tcg_gen_movi_i64(tmp, 0);
459
 
        tcg_gen_add2_i64(result, flag, t0, tmp, t1, tmp);
460
 
 
461
 
        tcg_gen_trunc_i64_i32(cpu_CF, flag);
462
 
 
463
 
        gen_set_NZ64(result);
464
 
 
465
 
        tcg_gen_xor_i64(flag, result, t0);
466
 
        tcg_gen_xor_i64(tmp, t0, t1);
467
 
        tcg_gen_andc_i64(flag, flag, tmp);
468
 
        tcg_temp_free_i64(tmp);
469
 
        tcg_gen_shri_i64(flag, flag, 32);
470
 
        tcg_gen_trunc_i64_i32(cpu_VF, flag);
471
 
 
472
 
        tcg_gen_mov_i64(dest, result);
473
 
        tcg_temp_free_i64(result);
474
 
        tcg_temp_free_i64(flag);
475
 
    } else {
476
 
        /* 32 bit arithmetic */
477
 
        TCGv_i32 t0_32 = tcg_temp_new_i32();
478
 
        TCGv_i32 t1_32 = tcg_temp_new_i32();
479
 
        TCGv_i32 tmp = tcg_temp_new_i32();
480
 
 
481
 
        tcg_gen_movi_i32(tmp, 0);
482
 
        tcg_gen_trunc_i64_i32(t0_32, t0);
483
 
        tcg_gen_trunc_i64_i32(t1_32, t1);
484
 
        tcg_gen_add2_i32(cpu_NF, cpu_CF, t0_32, tmp, t1_32, tmp);
485
 
        tcg_gen_mov_i32(cpu_ZF, cpu_NF);
486
 
        tcg_gen_xor_i32(cpu_VF, cpu_NF, t0_32);
487
 
        tcg_gen_xor_i32(tmp, t0_32, t1_32);
488
 
        tcg_gen_andc_i32(cpu_VF, cpu_VF, tmp);
489
 
        tcg_gen_extu_i32_i64(dest, cpu_NF);
490
 
 
491
 
        tcg_temp_free_i32(tmp);
492
 
        tcg_temp_free_i32(t0_32);
493
 
        tcg_temp_free_i32(t1_32);
494
 
    }
495
 
}
496
 
 
497
 
/* dest = T0 - T1; compute C, N, V and Z flags */
498
 
static void gen_sub_CC(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
499
 
{
500
 
    if (sf) {
501
 
        /* 64 bit arithmetic */
502
 
        TCGv_i64 result, flag, tmp;
503
 
 
504
 
        result = tcg_temp_new_i64();
505
 
        flag = tcg_temp_new_i64();
506
 
        tcg_gen_sub_i64(result, t0, t1);
507
 
 
508
 
        gen_set_NZ64(result);
509
 
 
510
 
        tcg_gen_setcond_i64(TCG_COND_GEU, flag, t0, t1);
511
 
        tcg_gen_trunc_i64_i32(cpu_CF, flag);
512
 
 
513
 
        tcg_gen_xor_i64(flag, result, t0);
514
 
        tmp = tcg_temp_new_i64();
515
 
        tcg_gen_xor_i64(tmp, t0, t1);
516
 
        tcg_gen_and_i64(flag, flag, tmp);
517
 
        tcg_temp_free_i64(tmp);
518
 
        tcg_gen_shri_i64(flag, flag, 32);
519
 
        tcg_gen_trunc_i64_i32(cpu_VF, flag);
520
 
        tcg_gen_mov_i64(dest, result);
521
 
        tcg_temp_free_i64(flag);
522
 
        tcg_temp_free_i64(result);
523
 
    } else {
524
 
        /* 32 bit arithmetic */
525
 
        TCGv_i32 t0_32 = tcg_temp_new_i32();
526
 
        TCGv_i32 t1_32 = tcg_temp_new_i32();
527
 
        TCGv_i32 tmp;
528
 
 
529
 
        tcg_gen_trunc_i64_i32(t0_32, t0);
530
 
        tcg_gen_trunc_i64_i32(t1_32, t1);
531
 
        tcg_gen_sub_i32(cpu_NF, t0_32, t1_32);
532
 
        tcg_gen_mov_i32(cpu_ZF, cpu_NF);
533
 
        tcg_gen_setcond_i32(TCG_COND_GEU, cpu_CF, t0_32, t1_32);
534
 
        tcg_gen_xor_i32(cpu_VF, cpu_NF, t0_32);
535
 
        tmp = tcg_temp_new_i32();
536
 
        tcg_gen_xor_i32(tmp, t0_32, t1_32);
537
 
        tcg_temp_free_i32(t0_32);
538
 
        tcg_temp_free_i32(t1_32);
539
 
        tcg_gen_and_i32(cpu_VF, cpu_VF, tmp);
540
 
        tcg_temp_free_i32(tmp);
541
 
        tcg_gen_extu_i32_i64(dest, cpu_NF);
542
 
    }
543
 
}
544
 
 
545
 
/* dest = T0 + T1 + CF; do not compute flags. */
546
 
static void gen_adc(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
547
 
{
548
 
    TCGv_i64 flag = tcg_temp_new_i64();
549
 
    tcg_gen_extu_i32_i64(flag, cpu_CF);
550
 
    tcg_gen_add_i64(dest, t0, t1);
551
 
    tcg_gen_add_i64(dest, dest, flag);
552
 
    tcg_temp_free_i64(flag);
553
 
 
554
 
    if (!sf) {
555
 
        tcg_gen_ext32u_i64(dest, dest);
556
 
    }
557
 
}
558
 
 
559
 
/* dest = T0 + T1 + CF; compute C, N, V and Z flags. */
560
 
static void gen_adc_CC(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
561
 
{
562
 
    if (sf) {
563
 
        TCGv_i64 result, cf_64, vf_64, tmp;
564
 
        result = tcg_temp_new_i64();
565
 
        cf_64 = tcg_temp_new_i64();
566
 
        vf_64 = tcg_temp_new_i64();
567
 
        tmp = tcg_const_i64(0);
568
 
 
569
 
        tcg_gen_extu_i32_i64(cf_64, cpu_CF);
570
 
        tcg_gen_add2_i64(result, cf_64, t0, tmp, cf_64, tmp);
571
 
        tcg_gen_add2_i64(result, cf_64, result, cf_64, t1, tmp);
572
 
        tcg_gen_trunc_i64_i32(cpu_CF, cf_64);
573
 
        gen_set_NZ64(result);
574
 
 
575
 
        tcg_gen_xor_i64(vf_64, result, t0);
576
 
        tcg_gen_xor_i64(tmp, t0, t1);
577
 
        tcg_gen_andc_i64(vf_64, vf_64, tmp);
578
 
        tcg_gen_shri_i64(vf_64, vf_64, 32);
579
 
        tcg_gen_trunc_i64_i32(cpu_VF, vf_64);
580
 
 
581
 
        tcg_gen_mov_i64(dest, result);
582
 
 
583
 
        tcg_temp_free_i64(tmp);
584
 
        tcg_temp_free_i64(vf_64);
585
 
        tcg_temp_free_i64(cf_64);
586
 
        tcg_temp_free_i64(result);
587
 
    } else {
588
 
        TCGv_i32 t0_32, t1_32, tmp;
589
 
        t0_32 = tcg_temp_new_i32();
590
 
        t1_32 = tcg_temp_new_i32();
591
 
        tmp = tcg_const_i32(0);
592
 
 
593
 
        tcg_gen_trunc_i64_i32(t0_32, t0);
594
 
        tcg_gen_trunc_i64_i32(t1_32, t1);
595
 
        tcg_gen_add2_i32(cpu_NF, cpu_CF, t0_32, tmp, cpu_CF, tmp);
596
 
        tcg_gen_add2_i32(cpu_NF, cpu_CF, cpu_NF, cpu_CF, t1_32, tmp);
597
 
 
598
 
        tcg_gen_mov_i32(cpu_ZF, cpu_NF);
599
 
        tcg_gen_xor_i32(cpu_VF, cpu_NF, t0_32);
600
 
        tcg_gen_xor_i32(tmp, t0_32, t1_32);
601
 
        tcg_gen_andc_i32(cpu_VF, cpu_VF, tmp);
602
 
        tcg_gen_extu_i32_i64(dest, cpu_NF);
603
 
 
604
 
        tcg_temp_free_i32(tmp);
605
 
        tcg_temp_free_i32(t1_32);
606
 
        tcg_temp_free_i32(t0_32);
607
 
    }
608
 
}
609
 
 
610
 
/*
611
 
 * Load/Store generators
612
 
 */
613
 
 
614
 
/*
615
 
 * Store from GPR register to memory
616
 
 */
617
 
static void do_gpr_st(DisasContext *s, TCGv_i64 source,
618
 
                      TCGv_i64 tcg_addr, int size)
619
 
{
620
 
    g_assert(size <= 3);
621
 
    tcg_gen_qemu_st_i64(source, tcg_addr, get_mem_index(s), MO_TE + size);
622
 
}
623
 
 
624
 
/*
625
 
 * Load from memory to GPR register
626
 
 */
627
 
static void do_gpr_ld(DisasContext *s, TCGv_i64 dest, TCGv_i64 tcg_addr,
628
 
                      int size, bool is_signed, bool extend)
629
 
{
630
 
    TCGMemOp memop = MO_TE + size;
631
 
 
632
 
    g_assert(size <= 3);
633
 
 
634
 
    if (is_signed) {
635
 
        memop += MO_SIGN;
636
 
    }
637
 
 
638
 
    tcg_gen_qemu_ld_i64(dest, tcg_addr, get_mem_index(s), memop);
639
 
 
640
 
    if (extend && is_signed) {
641
 
        g_assert(size < 3);
642
 
        tcg_gen_ext32u_i64(dest, dest);
643
 
    }
644
 
}
645
 
 
646
 
/*
647
 
 * Store from FP register to memory
648
 
 */
649
 
static void do_fp_st(DisasContext *s, int srcidx, TCGv_i64 tcg_addr, int size)
650
 
{
651
 
    /* This writes the bottom N bits of a 128 bit wide vector to memory */
652
 
    TCGv_i64 tmp = tcg_temp_new_i64();
653
 
    tcg_gen_ld_i64(tmp, cpu_env, fp_reg_offset(srcidx, MO_64));
654
 
    if (size < 4) {
655
 
        tcg_gen_qemu_st_i64(tmp, tcg_addr, get_mem_index(s), MO_TE + size);
656
 
    } else {
657
 
        TCGv_i64 tcg_hiaddr = tcg_temp_new_i64();
658
 
        tcg_gen_qemu_st_i64(tmp, tcg_addr, get_mem_index(s), MO_TEQ);
659
 
        tcg_gen_qemu_st64(tmp, tcg_addr, get_mem_index(s));
660
 
        tcg_gen_ld_i64(tmp, cpu_env, fp_reg_hi_offset(srcidx));
661
 
        tcg_gen_addi_i64(tcg_hiaddr, tcg_addr, 8);
662
 
        tcg_gen_qemu_st_i64(tmp, tcg_hiaddr, get_mem_index(s), MO_TEQ);
663
 
        tcg_temp_free_i64(tcg_hiaddr);
664
 
    }
665
 
 
666
 
    tcg_temp_free_i64(tmp);
667
 
}
668
 
 
669
 
/*
670
 
 * Load from memory to FP register
671
 
 */
672
 
static void do_fp_ld(DisasContext *s, int destidx, TCGv_i64 tcg_addr, int size)
673
 
{
674
 
    /* This always zero-extends and writes to a full 128 bit wide vector */
675
 
    TCGv_i64 tmplo = tcg_temp_new_i64();
676
 
    TCGv_i64 tmphi;
677
 
 
678
 
    if (size < 4) {
679
 
        TCGMemOp memop = MO_TE + size;
680
 
        tmphi = tcg_const_i64(0);
681
 
        tcg_gen_qemu_ld_i64(tmplo, tcg_addr, get_mem_index(s), memop);
682
 
    } else {
683
 
        TCGv_i64 tcg_hiaddr;
684
 
        tmphi = tcg_temp_new_i64();
685
 
        tcg_hiaddr = tcg_temp_new_i64();
686
 
 
687
 
        tcg_gen_qemu_ld_i64(tmplo, tcg_addr, get_mem_index(s), MO_TEQ);
688
 
        tcg_gen_addi_i64(tcg_hiaddr, tcg_addr, 8);
689
 
        tcg_gen_qemu_ld_i64(tmphi, tcg_hiaddr, get_mem_index(s), MO_TEQ);
690
 
        tcg_temp_free_i64(tcg_hiaddr);
691
 
    }
692
 
 
693
 
    tcg_gen_st_i64(tmplo, cpu_env, fp_reg_offset(destidx, MO_64));
694
 
    tcg_gen_st_i64(tmphi, cpu_env, fp_reg_hi_offset(destidx));
695
 
 
696
 
    tcg_temp_free_i64(tmplo);
697
 
    tcg_temp_free_i64(tmphi);
698
 
}
699
 
 
700
 
/*
701
 
 * Vector load/store helpers.
702
 
 *
703
 
 * The principal difference between this and a FP load is that we don't
704
 
 * zero extend as we are filling a partial chunk of the vector register.
705
 
 * These functions don't support 128 bit loads/stores, which would be
706
 
 * normal load/store operations.
707
 
 *
708
 
 * The _i32 versions are useful when operating on 32 bit quantities
709
 
 * (eg for floating point single or using Neon helper functions).
710
 
 */
711
 
 
712
 
/* Get value of an element within a vector register */
713
 
static void read_vec_element(DisasContext *s, TCGv_i64 tcg_dest, int srcidx,
714
 
                             int element, TCGMemOp memop)
715
 
{
716
 
    int vect_off = vec_reg_offset(srcidx, element, memop & MO_SIZE);
717
 
    switch (memop) {
718
 
    case MO_8:
719
 
        tcg_gen_ld8u_i64(tcg_dest, cpu_env, vect_off);
720
 
        break;
721
 
    case MO_16:
722
 
        tcg_gen_ld16u_i64(tcg_dest, cpu_env, vect_off);
723
 
        break;
724
 
    case MO_32:
725
 
        tcg_gen_ld32u_i64(tcg_dest, cpu_env, vect_off);
726
 
        break;
727
 
    case MO_8|MO_SIGN:
728
 
        tcg_gen_ld8s_i64(tcg_dest, cpu_env, vect_off);
729
 
        break;
730
 
    case MO_16|MO_SIGN:
731
 
        tcg_gen_ld16s_i64(tcg_dest, cpu_env, vect_off);
732
 
        break;
733
 
    case MO_32|MO_SIGN:
734
 
        tcg_gen_ld32s_i64(tcg_dest, cpu_env, vect_off);
735
 
        break;
736
 
    case MO_64:
737
 
    case MO_64|MO_SIGN:
738
 
        tcg_gen_ld_i64(tcg_dest, cpu_env, vect_off);
739
 
        break;
740
 
    default:
741
 
        g_assert_not_reached();
742
 
    }
743
 
}
744
 
 
745
 
static void read_vec_element_i32(DisasContext *s, TCGv_i32 tcg_dest, int srcidx,
746
 
                                 int element, TCGMemOp memop)
747
 
{
748
 
    int vect_off = vec_reg_offset(srcidx, element, memop & MO_SIZE);
749
 
    switch (memop) {
750
 
    case MO_8:
751
 
        tcg_gen_ld8u_i32(tcg_dest, cpu_env, vect_off);
752
 
        break;
753
 
    case MO_16:
754
 
        tcg_gen_ld16u_i32(tcg_dest, cpu_env, vect_off);
755
 
        break;
756
 
    case MO_8|MO_SIGN:
757
 
        tcg_gen_ld8s_i32(tcg_dest, cpu_env, vect_off);
758
 
        break;
759
 
    case MO_16|MO_SIGN:
760
 
        tcg_gen_ld16s_i32(tcg_dest, cpu_env, vect_off);
761
 
        break;
762
 
    case MO_32:
763
 
    case MO_32|MO_SIGN:
764
 
        tcg_gen_ld_i32(tcg_dest, cpu_env, vect_off);
765
 
        break;
766
 
    default:
767
 
        g_assert_not_reached();
768
 
    }
769
 
}
770
 
 
771
 
/* Set value of an element within a vector register */
772
 
static void write_vec_element(DisasContext *s, TCGv_i64 tcg_src, int destidx,
773
 
                              int element, TCGMemOp memop)
774
 
{
775
 
    int vect_off = vec_reg_offset(destidx, element, memop & MO_SIZE);
776
 
    switch (memop) {
777
 
    case MO_8:
778
 
        tcg_gen_st8_i64(tcg_src, cpu_env, vect_off);
779
 
        break;
780
 
    case MO_16:
781
 
        tcg_gen_st16_i64(tcg_src, cpu_env, vect_off);
782
 
        break;
783
 
    case MO_32:
784
 
        tcg_gen_st32_i64(tcg_src, cpu_env, vect_off);
785
 
        break;
786
 
    case MO_64:
787
 
        tcg_gen_st_i64(tcg_src, cpu_env, vect_off);
788
 
        break;
789
 
    default:
790
 
        g_assert_not_reached();
791
 
    }
792
 
}
793
 
 
794
 
static void write_vec_element_i32(DisasContext *s, TCGv_i32 tcg_src,
795
 
                                  int destidx, int element, TCGMemOp memop)
796
 
{
797
 
    int vect_off = vec_reg_offset(destidx, element, memop & MO_SIZE);
798
 
    switch (memop) {
799
 
    case MO_8:
800
 
        tcg_gen_st8_i32(tcg_src, cpu_env, vect_off);
801
 
        break;
802
 
    case MO_16:
803
 
        tcg_gen_st16_i32(tcg_src, cpu_env, vect_off);
804
 
        break;
805
 
    case MO_32:
806
 
        tcg_gen_st_i32(tcg_src, cpu_env, vect_off);
807
 
        break;
808
 
    default:
809
 
        g_assert_not_reached();
810
 
    }
811
 
}
812
 
 
813
 
/* Clear the high 64 bits of a 128 bit vector (in general non-quad
814
 
 * vector ops all need to do this).
815
 
 */
816
 
static void clear_vec_high(DisasContext *s, int rd)
817
 
{
818
 
    TCGv_i64 tcg_zero = tcg_const_i64(0);
819
 
 
820
 
    write_vec_element(s, tcg_zero, rd, 1, MO_64);
821
 
    tcg_temp_free_i64(tcg_zero);
822
 
}
823
 
 
824
 
/* Store from vector register to memory */
825
 
static void do_vec_st(DisasContext *s, int srcidx, int element,
826
 
                      TCGv_i64 tcg_addr, int size)
827
 
{
828
 
    TCGMemOp memop = MO_TE + size;
829
 
    TCGv_i64 tcg_tmp = tcg_temp_new_i64();
830
 
 
831
 
    read_vec_element(s, tcg_tmp, srcidx, element, size);
832
 
    tcg_gen_qemu_st_i64(tcg_tmp, tcg_addr, get_mem_index(s), memop);
833
 
 
834
 
    tcg_temp_free_i64(tcg_tmp);
835
 
}
836
 
 
837
 
/* Load from memory to vector register */
838
 
static void do_vec_ld(DisasContext *s, int destidx, int element,
839
 
                      TCGv_i64 tcg_addr, int size)
840
 
{
841
 
    TCGMemOp memop = MO_TE + size;
842
 
    TCGv_i64 tcg_tmp = tcg_temp_new_i64();
843
 
 
844
 
    tcg_gen_qemu_ld_i64(tcg_tmp, tcg_addr, get_mem_index(s), memop);
845
 
    write_vec_element(s, tcg_tmp, destidx, element, size);
846
 
 
847
 
    tcg_temp_free_i64(tcg_tmp);
848
 
}
849
 
 
850
 
/*
851
 
 * This utility function is for doing register extension with an
852
 
 * optional shift. You will likely want to pass a temporary for the
853
 
 * destination register. See DecodeRegExtend() in the ARM ARM.
854
 
 */
855
 
static void ext_and_shift_reg(TCGv_i64 tcg_out, TCGv_i64 tcg_in,
856
 
                              int option, unsigned int shift)
857
 
{
858
 
    int extsize = extract32(option, 0, 2);
859
 
    bool is_signed = extract32(option, 2, 1);
860
 
 
861
 
    if (is_signed) {
862
 
        switch (extsize) {
863
 
        case 0:
864
 
            tcg_gen_ext8s_i64(tcg_out, tcg_in);
865
 
            break;
866
 
        case 1:
867
 
            tcg_gen_ext16s_i64(tcg_out, tcg_in);
868
 
            break;
869
 
        case 2:
870
 
            tcg_gen_ext32s_i64(tcg_out, tcg_in);
871
 
            break;
872
 
        case 3:
873
 
            tcg_gen_mov_i64(tcg_out, tcg_in);
874
 
            break;
875
 
        }
876
 
    } else {
877
 
        switch (extsize) {
878
 
        case 0:
879
 
            tcg_gen_ext8u_i64(tcg_out, tcg_in);
880
 
            break;
881
 
        case 1:
882
 
            tcg_gen_ext16u_i64(tcg_out, tcg_in);
883
 
            break;
884
 
        case 2:
885
 
            tcg_gen_ext32u_i64(tcg_out, tcg_in);
886
 
            break;
887
 
        case 3:
888
 
            tcg_gen_mov_i64(tcg_out, tcg_in);
889
 
            break;
890
 
        }
891
 
    }
892
 
 
893
 
    if (shift) {
894
 
        tcg_gen_shli_i64(tcg_out, tcg_out, shift);
895
 
    }
896
 
}
897
 
 
898
 
static inline void gen_check_sp_alignment(DisasContext *s)
899
 
{
900
 
    /* The AArch64 architecture mandates that (if enabled via PSTATE
901
 
     * or SCTLR bits) there is a check that SP is 16-aligned on every
902
 
     * SP-relative load or store (with an exception generated if it is not).
903
 
     * In line with general QEMU practice regarding misaligned accesses,
904
 
     * we omit these checks for the sake of guest program performance.
905
 
     * This function is provided as a hook so we can more easily add these
906
 
     * checks in future (possibly as a "favour catching guest program bugs
907
 
     * over speed" user selectable option).
908
 
     */
909
 
}
910
 
 
911
 
/*
912
 
 * This provides a simple table based table lookup decoder. It is
913
 
 * intended to be used when the relevant bits for decode are too
914
 
 * awkwardly placed and switch/if based logic would be confusing and
915
 
 * deeply nested. Since it's a linear search through the table, tables
916
 
 * should be kept small.
917
 
 *
918
 
 * It returns the first handler where insn & mask == pattern, or
919
 
 * NULL if there is no match.
920
 
 * The table is terminated by an empty mask (i.e. 0)
921
 
 */
922
 
static inline AArch64DecodeFn *lookup_disas_fn(const AArch64DecodeTable *table,
923
 
                                               uint32_t insn)
924
 
{
925
 
    const AArch64DecodeTable *tptr = table;
926
 
 
927
 
    while (tptr->mask) {
928
 
        if ((insn & tptr->mask) == tptr->pattern) {
929
 
            return tptr->disas_fn;
930
 
        }
931
 
        tptr++;
932
 
    }
933
 
    return NULL;
934
 
}
935
 
 
936
 
/*
937
 
 * the instruction disassembly implemented here matches
938
 
 * the instruction encoding classifications in chapter 3 (C3)
939
 
 * of the ARM Architecture Reference Manual (DDI0487A_a)
940
 
 */
941
 
 
942
 
/* C3.2.7 Unconditional branch (immediate)
943
 
 *   31  30       26 25                                  0
944
 
 * +----+-----------+-------------------------------------+
945
 
 * | op | 0 0 1 0 1 |                 imm26               |
946
 
 * +----+-----------+-------------------------------------+
947
 
 */
948
 
static void disas_uncond_b_imm(DisasContext *s, uint32_t insn)
949
 
{
950
 
    uint64_t addr = s->pc + sextract32(insn, 0, 26) * 4 - 4;
951
 
 
952
 
    if (insn & (1 << 31)) {
953
 
        /* C5.6.26 BL Branch with link */
954
 
        tcg_gen_movi_i64(cpu_reg(s, 30), s->pc);
955
 
    }
956
 
 
957
 
    /* C5.6.20 B Branch / C5.6.26 BL Branch with link */
958
 
    gen_goto_tb(s, 0, addr);
959
 
}
960
 
 
961
 
/* C3.2.1 Compare & branch (immediate)
962
 
 *   31  30         25  24  23                  5 4      0
963
 
 * +----+-------------+----+---------------------+--------+
964
 
 * | sf | 0 1 1 0 1 0 | op |         imm19       |   Rt   |
965
 
 * +----+-------------+----+---------------------+--------+
966
 
 */
967
 
static void disas_comp_b_imm(DisasContext *s, uint32_t insn)
968
 
{
969
 
    unsigned int sf, op, rt;
970
 
    uint64_t addr;
971
 
    int label_match;
972
 
    TCGv_i64 tcg_cmp;
973
 
 
974
 
    sf = extract32(insn, 31, 1);
975
 
    op = extract32(insn, 24, 1); /* 0: CBZ; 1: CBNZ */
976
 
    rt = extract32(insn, 0, 5);
977
 
    addr = s->pc + sextract32(insn, 5, 19) * 4 - 4;
978
 
 
979
 
    tcg_cmp = read_cpu_reg(s, rt, sf);
980
 
    label_match = gen_new_label();
981
 
 
982
 
    tcg_gen_brcondi_i64(op ? TCG_COND_NE : TCG_COND_EQ,
983
 
                        tcg_cmp, 0, label_match);
984
 
 
985
 
    gen_goto_tb(s, 0, s->pc);
986
 
    gen_set_label(label_match);
987
 
    gen_goto_tb(s, 1, addr);
988
 
}
989
 
 
990
 
/* C3.2.5 Test & branch (immediate)
991
 
 *   31  30         25  24  23   19 18          5 4    0
992
 
 * +----+-------------+----+-------+-------------+------+
993
 
 * | b5 | 0 1 1 0 1 1 | op |  b40  |    imm14    |  Rt  |
994
 
 * +----+-------------+----+-------+-------------+------+
995
 
 */
996
 
static void disas_test_b_imm(DisasContext *s, uint32_t insn)
997
 
{
998
 
    unsigned int bit_pos, op, rt;
999
 
    uint64_t addr;
1000
 
    int label_match;
1001
 
    TCGv_i64 tcg_cmp;
1002
 
 
1003
 
    bit_pos = (extract32(insn, 31, 1) << 5) | extract32(insn, 19, 5);
1004
 
    op = extract32(insn, 24, 1); /* 0: TBZ; 1: TBNZ */
1005
 
    addr = s->pc + sextract32(insn, 5, 14) * 4 - 4;
1006
 
    rt = extract32(insn, 0, 5);
1007
 
 
1008
 
    tcg_cmp = tcg_temp_new_i64();
1009
 
    tcg_gen_andi_i64(tcg_cmp, cpu_reg(s, rt), (1ULL << bit_pos));
1010
 
    label_match = gen_new_label();
1011
 
    tcg_gen_brcondi_i64(op ? TCG_COND_NE : TCG_COND_EQ,
1012
 
                        tcg_cmp, 0, label_match);
1013
 
    tcg_temp_free_i64(tcg_cmp);
1014
 
    gen_goto_tb(s, 0, s->pc);
1015
 
    gen_set_label(label_match);
1016
 
    gen_goto_tb(s, 1, addr);
1017
 
}
1018
 
 
1019
 
/* C3.2.2 / C5.6.19 Conditional branch (immediate)
1020
 
 *  31           25  24  23                  5   4  3    0
1021
 
 * +---------------+----+---------------------+----+------+
1022
 
 * | 0 1 0 1 0 1 0 | o1 |         imm19       | o0 | cond |
1023
 
 * +---------------+----+---------------------+----+------+
1024
 
 */
1025
 
static void disas_cond_b_imm(DisasContext *s, uint32_t insn)
1026
 
{
1027
 
    unsigned int cond;
1028
 
    uint64_t addr;
1029
 
 
1030
 
    if ((insn & (1 << 4)) || (insn & (1 << 24))) {
1031
 
        unallocated_encoding(s);
1032
 
        return;
1033
 
    }
1034
 
    addr = s->pc + sextract32(insn, 5, 19) * 4 - 4;
1035
 
    cond = extract32(insn, 0, 4);
1036
 
 
1037
 
    if (cond < 0x0e) {
1038
 
        /* genuinely conditional branches */
1039
 
        int label_match = gen_new_label();
1040
 
        arm_gen_test_cc(cond, label_match);
1041
 
        gen_goto_tb(s, 0, s->pc);
1042
 
        gen_set_label(label_match);
1043
 
        gen_goto_tb(s, 1, addr);
1044
 
    } else {
1045
 
        /* 0xe and 0xf are both "always" conditions */
1046
 
        gen_goto_tb(s, 0, addr);
1047
 
    }
1048
 
}
1049
 
 
1050
 
/* C5.6.68 HINT */
1051
 
static void handle_hint(DisasContext *s, uint32_t insn,
1052
 
                        unsigned int op1, unsigned int op2, unsigned int crm)
1053
 
{
1054
 
    unsigned int selector = crm << 3 | op2;
1055
 
 
1056
 
    if (op1 != 3) {
1057
 
        unallocated_encoding(s);
1058
 
        return;
1059
 
    }
1060
 
 
1061
 
    switch (selector) {
1062
 
    case 0: /* NOP */
1063
 
        return;
1064
 
    case 1: /* YIELD */
1065
 
    case 2: /* WFE */
1066
 
    case 3: /* WFI */
1067
 
    case 4: /* SEV */
1068
 
    case 5: /* SEVL */
1069
 
        /* we treat all as NOP at least for now */
1070
 
        return;
1071
 
    default:
1072
 
        /* default specified as NOP equivalent */
1073
 
        return;
1074
 
    }
1075
 
}
1076
 
 
1077
 
static void gen_clrex(DisasContext *s, uint32_t insn)
1078
 
{
1079
 
    tcg_gen_movi_i64(cpu_exclusive_addr, -1);
1080
 
}
1081
 
 
1082
 
/* CLREX, DSB, DMB, ISB */
1083
 
static void handle_sync(DisasContext *s, uint32_t insn,
1084
 
                        unsigned int op1, unsigned int op2, unsigned int crm)
1085
 
{
1086
 
    if (op1 != 3) {
1087
 
        unallocated_encoding(s);
1088
 
        return;
1089
 
    }
1090
 
 
1091
 
    switch (op2) {
1092
 
    case 2: /* CLREX */
1093
 
        gen_clrex(s, insn);
1094
 
        return;
1095
 
    case 4: /* DSB */
1096
 
    case 5: /* DMB */
1097
 
    case 6: /* ISB */
1098
 
        /* We don't emulate caches so barriers are no-ops */
1099
 
        return;
1100
 
    default:
1101
 
        unallocated_encoding(s);
1102
 
        return;
1103
 
    }
1104
 
}
1105
 
 
1106
 
/* C5.6.130 MSR (immediate) - move immediate to processor state field */
1107
 
static void handle_msr_i(DisasContext *s, uint32_t insn,
1108
 
                         unsigned int op1, unsigned int op2, unsigned int crm)
1109
 
{
1110
 
    unsupported_encoding(s, insn);
1111
 
}
1112
 
 
1113
 
static void gen_get_nzcv(TCGv_i64 tcg_rt)
1114
 
{
1115
 
    TCGv_i32 tmp = tcg_temp_new_i32();
1116
 
    TCGv_i32 nzcv = tcg_temp_new_i32();
1117
 
 
1118
 
    /* build bit 31, N */
1119
 
    tcg_gen_andi_i32(nzcv, cpu_NF, (1 << 31));
1120
 
    /* build bit 30, Z */
1121
 
    tcg_gen_setcondi_i32(TCG_COND_EQ, tmp, cpu_ZF, 0);
1122
 
    tcg_gen_deposit_i32(nzcv, nzcv, tmp, 30, 1);
1123
 
    /* build bit 29, C */
1124
 
    tcg_gen_deposit_i32(nzcv, nzcv, cpu_CF, 29, 1);
1125
 
    /* build bit 28, V */
1126
 
    tcg_gen_shri_i32(tmp, cpu_VF, 31);
1127
 
    tcg_gen_deposit_i32(nzcv, nzcv, tmp, 28, 1);
1128
 
    /* generate result */
1129
 
    tcg_gen_extu_i32_i64(tcg_rt, nzcv);
1130
 
 
1131
 
    tcg_temp_free_i32(nzcv);
1132
 
    tcg_temp_free_i32(tmp);
1133
 
}
1134
 
 
1135
 
static void gen_set_nzcv(TCGv_i64 tcg_rt)
1136
 
 
1137
 
{
1138
 
    TCGv_i32 nzcv = tcg_temp_new_i32();
1139
 
 
1140
 
    /* take NZCV from R[t] */
1141
 
    tcg_gen_trunc_i64_i32(nzcv, tcg_rt);
1142
 
 
1143
 
    /* bit 31, N */
1144
 
    tcg_gen_andi_i32(cpu_NF, nzcv, (1 << 31));
1145
 
    /* bit 30, Z */
1146
 
    tcg_gen_andi_i32(cpu_ZF, nzcv, (1 << 30));
1147
 
    tcg_gen_setcondi_i32(TCG_COND_EQ, cpu_ZF, cpu_ZF, 0);
1148
 
    /* bit 29, C */
1149
 
    tcg_gen_andi_i32(cpu_CF, nzcv, (1 << 29));
1150
 
    tcg_gen_shri_i32(cpu_CF, cpu_CF, 29);
1151
 
    /* bit 28, V */
1152
 
    tcg_gen_andi_i32(cpu_VF, nzcv, (1 << 28));
1153
 
    tcg_gen_shli_i32(cpu_VF, cpu_VF, 3);
1154
 
    tcg_temp_free_i32(nzcv);
1155
 
}
1156
 
 
1157
 
/* C5.6.129 MRS - move from system register
1158
 
 * C5.6.131 MSR (register) - move to system register
1159
 
 * C5.6.204 SYS
1160
 
 * C5.6.205 SYSL
1161
 
 * These are all essentially the same insn in 'read' and 'write'
1162
 
 * versions, with varying op0 fields.
1163
 
 */
1164
 
static void handle_sys(DisasContext *s, uint32_t insn, bool isread,
1165
 
                       unsigned int op0, unsigned int op1, unsigned int op2,
1166
 
                       unsigned int crn, unsigned int crm, unsigned int rt)
1167
 
{
1168
 
    const ARMCPRegInfo *ri;
1169
 
    TCGv_i64 tcg_rt;
1170
 
 
1171
 
    ri = get_arm_cp_reginfo(s->cp_regs,
1172
 
                            ENCODE_AA64_CP_REG(CP_REG_ARM64_SYSREG_CP,
1173
 
                                               crn, crm, op0, op1, op2));
1174
 
 
1175
 
    if (!ri) {
1176
 
        /* Unknown register */
1177
 
        unallocated_encoding(s);
1178
 
        return;
1179
 
    }
1180
 
 
1181
 
    /* Check access permissions */
1182
 
    if (!cp_access_ok(s->current_pl, ri, isread)) {
1183
 
        unallocated_encoding(s);
1184
 
        return;
1185
 
    }
1186
 
 
1187
 
    /* Handle special cases first */
1188
 
    switch (ri->type & ~(ARM_CP_FLAG_MASK & ~ARM_CP_SPECIAL)) {
1189
 
    case ARM_CP_NOP:
1190
 
        return;
1191
 
    case ARM_CP_NZCV:
1192
 
        tcg_rt = cpu_reg(s, rt);
1193
 
        if (isread) {
1194
 
            gen_get_nzcv(tcg_rt);
1195
 
        } else {
1196
 
            gen_set_nzcv(tcg_rt);
1197
 
        }
1198
 
        return;
1199
 
    default:
1200
 
        break;
1201
 
    }
1202
 
 
1203
 
    if (use_icount && (ri->type & ARM_CP_IO)) {
1204
 
        gen_io_start();
1205
 
    }
1206
 
 
1207
 
    tcg_rt = cpu_reg(s, rt);
1208
 
 
1209
 
    if (isread) {
1210
 
        if (ri->type & ARM_CP_CONST) {
1211
 
            tcg_gen_movi_i64(tcg_rt, ri->resetvalue);
1212
 
        } else if (ri->readfn) {
1213
 
            TCGv_ptr tmpptr;
1214
 
            gen_a64_set_pc_im(s->pc - 4);
1215
 
            tmpptr = tcg_const_ptr(ri);
1216
 
            gen_helper_get_cp_reg64(tcg_rt, cpu_env, tmpptr);
1217
 
            tcg_temp_free_ptr(tmpptr);
1218
 
        } else {
1219
 
            tcg_gen_ld_i64(tcg_rt, cpu_env, ri->fieldoffset);
1220
 
        }
1221
 
    } else {
1222
 
        if (ri->type & ARM_CP_CONST) {
1223
 
            /* If not forbidden by access permissions, treat as WI */
1224
 
            return;
1225
 
        } else if (ri->writefn) {
1226
 
            TCGv_ptr tmpptr;
1227
 
            gen_a64_set_pc_im(s->pc - 4);
1228
 
            tmpptr = tcg_const_ptr(ri);
1229
 
            gen_helper_set_cp_reg64(cpu_env, tmpptr, tcg_rt);
1230
 
            tcg_temp_free_ptr(tmpptr);
1231
 
        } else {
1232
 
            tcg_gen_st_i64(tcg_rt, cpu_env, ri->fieldoffset);
1233
 
        }
1234
 
    }
1235
 
 
1236
 
    if (use_icount && (ri->type & ARM_CP_IO)) {
1237
 
        /* I/O operations must end the TB here (whether read or write) */
1238
 
        gen_io_end();
1239
 
        s->is_jmp = DISAS_UPDATE;
1240
 
    } else if (!isread && !(ri->type & ARM_CP_SUPPRESS_TB_END)) {
1241
 
        /* We default to ending the TB on a coprocessor register write,
1242
 
         * but allow this to be suppressed by the register definition
1243
 
         * (usually only necessary to work around guest bugs).
1244
 
         */
1245
 
        s->is_jmp = DISAS_UPDATE;
1246
 
    }
1247
 
}
1248
 
 
1249
 
/* C3.2.4 System
1250
 
 *  31                 22 21  20 19 18 16 15   12 11    8 7   5 4    0
1251
 
 * +---------------------+---+-----+-----+-------+-------+-----+------+
1252
 
 * | 1 1 0 1 0 1 0 1 0 0 | L | op0 | op1 |  CRn  |  CRm  | op2 |  Rt  |
1253
 
 * +---------------------+---+-----+-----+-------+-------+-----+------+
1254
 
 */
1255
 
static void disas_system(DisasContext *s, uint32_t insn)
1256
 
{
1257
 
    unsigned int l, op0, op1, crn, crm, op2, rt;
1258
 
    l = extract32(insn, 21, 1);
1259
 
    op0 = extract32(insn, 19, 2);
1260
 
    op1 = extract32(insn, 16, 3);
1261
 
    crn = extract32(insn, 12, 4);
1262
 
    crm = extract32(insn, 8, 4);
1263
 
    op2 = extract32(insn, 5, 3);
1264
 
    rt = extract32(insn, 0, 5);
1265
 
 
1266
 
    if (op0 == 0) {
1267
 
        if (l || rt != 31) {
1268
 
            unallocated_encoding(s);
1269
 
            return;
1270
 
        }
1271
 
        switch (crn) {
1272
 
        case 2: /* C5.6.68 HINT */
1273
 
            handle_hint(s, insn, op1, op2, crm);
1274
 
            break;
1275
 
        case 3: /* CLREX, DSB, DMB, ISB */
1276
 
            handle_sync(s, insn, op1, op2, crm);
1277
 
            break;
1278
 
        case 4: /* C5.6.130 MSR (immediate) */
1279
 
            handle_msr_i(s, insn, op1, op2, crm);
1280
 
            break;
1281
 
        default:
1282
 
            unallocated_encoding(s);
1283
 
            break;
1284
 
        }
1285
 
        return;
1286
 
    }
1287
 
    handle_sys(s, insn, l, op0, op1, op2, crn, crm, rt);
1288
 
}
1289
 
 
1290
 
/* C3.2.3 Exception generation
1291
 
 *
1292
 
 *  31             24 23 21 20                     5 4   2 1  0
1293
 
 * +-----------------+-----+------------------------+-----+----+
1294
 
 * | 1 1 0 1 0 1 0 0 | opc |          imm16         | op2 | LL |
1295
 
 * +-----------------------+------------------------+----------+
1296
 
 */
1297
 
static void disas_exc(DisasContext *s, uint32_t insn)
1298
 
{
1299
 
    int opc = extract32(insn, 21, 3);
1300
 
    int op2_ll = extract32(insn, 0, 5);
1301
 
 
1302
 
    switch (opc) {
1303
 
    case 0:
1304
 
        /* SVC, HVC, SMC; since we don't support the Virtualization
1305
 
         * or TrustZone extensions these all UNDEF except SVC.
1306
 
         */
1307
 
        if (op2_ll != 1) {
1308
 
            unallocated_encoding(s);
1309
 
            break;
1310
 
        }
1311
 
        gen_exception_insn(s, 0, EXCP_SWI);
1312
 
        break;
1313
 
    case 1:
1314
 
        if (op2_ll != 0) {
1315
 
            unallocated_encoding(s);
1316
 
            break;
1317
 
        }
1318
 
        /* BRK */
1319
 
        gen_exception_insn(s, 0, EXCP_BKPT);
1320
 
        break;
1321
 
    case 2:
1322
 
        if (op2_ll != 0) {
1323
 
            unallocated_encoding(s);
1324
 
            break;
1325
 
        }
1326
 
        /* HLT */
1327
 
        unsupported_encoding(s, insn);
1328
 
        break;
1329
 
    case 5:
1330
 
        if (op2_ll < 1 || op2_ll > 3) {
1331
 
            unallocated_encoding(s);
1332
 
            break;
1333
 
        }
1334
 
        /* DCPS1, DCPS2, DCPS3 */
1335
 
        unsupported_encoding(s, insn);
1336
 
        break;
1337
 
    default:
1338
 
        unallocated_encoding(s);
1339
 
        break;
1340
 
    }
1341
 
}
1342
 
 
1343
 
/* C3.2.7 Unconditional branch (register)
1344
 
 *  31           25 24   21 20   16 15   10 9    5 4     0
1345
 
 * +---------------+-------+-------+-------+------+-------+
1346
 
 * | 1 1 0 1 0 1 1 |  opc  |  op2  |  op3  |  Rn  |  op4  |
1347
 
 * +---------------+-------+-------+-------+------+-------+
1348
 
 */
1349
 
static void disas_uncond_b_reg(DisasContext *s, uint32_t insn)
1350
 
{
1351
 
    unsigned int opc, op2, op3, rn, op4;
1352
 
 
1353
 
    opc = extract32(insn, 21, 4);
1354
 
    op2 = extract32(insn, 16, 5);
1355
 
    op3 = extract32(insn, 10, 6);
1356
 
    rn = extract32(insn, 5, 5);
1357
 
    op4 = extract32(insn, 0, 5);
1358
 
 
1359
 
    if (op4 != 0x0 || op3 != 0x0 || op2 != 0x1f) {
1360
 
        unallocated_encoding(s);
1361
 
        return;
1362
 
    }
1363
 
 
1364
 
    switch (opc) {
1365
 
    case 0: /* BR */
1366
 
    case 2: /* RET */
1367
 
        break;
1368
 
    case 1: /* BLR */
1369
 
        tcg_gen_movi_i64(cpu_reg(s, 30), s->pc);
1370
 
        break;
1371
 
    case 4: /* ERET */
1372
 
    case 5: /* DRPS */
1373
 
        if (rn != 0x1f) {
1374
 
            unallocated_encoding(s);
1375
 
        } else {
1376
 
            unsupported_encoding(s, insn);
1377
 
        }
1378
 
        return;
1379
 
    default:
1380
 
        unallocated_encoding(s);
1381
 
        return;
1382
 
    }
1383
 
 
1384
 
    tcg_gen_mov_i64(cpu_pc, cpu_reg(s, rn));
1385
 
    s->is_jmp = DISAS_JUMP;
1386
 
}
1387
 
 
1388
 
/* C3.2 Branches, exception generating and system instructions */
1389
 
static void disas_b_exc_sys(DisasContext *s, uint32_t insn)
1390
 
{
1391
 
    switch (extract32(insn, 25, 7)) {
1392
 
    case 0x0a: case 0x0b:
1393
 
    case 0x4a: case 0x4b: /* Unconditional branch (immediate) */
1394
 
        disas_uncond_b_imm(s, insn);
1395
 
        break;
1396
 
    case 0x1a: case 0x5a: /* Compare & branch (immediate) */
1397
 
        disas_comp_b_imm(s, insn);
1398
 
        break;
1399
 
    case 0x1b: case 0x5b: /* Test & branch (immediate) */
1400
 
        disas_test_b_imm(s, insn);
1401
 
        break;
1402
 
    case 0x2a: /* Conditional branch (immediate) */
1403
 
        disas_cond_b_imm(s, insn);
1404
 
        break;
1405
 
    case 0x6a: /* Exception generation / System */
1406
 
        if (insn & (1 << 24)) {
1407
 
            disas_system(s, insn);
1408
 
        } else {
1409
 
            disas_exc(s, insn);
1410
 
        }
1411
 
        break;
1412
 
    case 0x6b: /* Unconditional branch (register) */
1413
 
        disas_uncond_b_reg(s, insn);
1414
 
        break;
1415
 
    default:
1416
 
        unallocated_encoding(s);
1417
 
        break;
1418
 
    }
1419
 
}
1420
 
 
1421
 
/*
1422
 
 * Load/Store exclusive instructions are implemented by remembering
1423
 
 * the value/address loaded, and seeing if these are the same
1424
 
 * when the store is performed. This is not actually the architecturally
1425
 
 * mandated semantics, but it works for typical guest code sequences
1426
 
 * and avoids having to monitor regular stores.
1427
 
 *
1428
 
 * In system emulation mode only one CPU will be running at once, so
1429
 
 * this sequence is effectively atomic.  In user emulation mode we
1430
 
 * throw an exception and handle the atomic operation elsewhere.
1431
 
 */
1432
 
static void gen_load_exclusive(DisasContext *s, int rt, int rt2,
1433
 
                               TCGv_i64 addr, int size, bool is_pair)
1434
 
{
1435
 
    TCGv_i64 tmp = tcg_temp_new_i64();
1436
 
    TCGMemOp memop = MO_TE + size;
1437
 
 
1438
 
    g_assert(size <= 3);
1439
 
    tcg_gen_qemu_ld_i64(tmp, addr, get_mem_index(s), memop);
1440
 
 
1441
 
    if (is_pair) {
1442
 
        TCGv_i64 addr2 = tcg_temp_new_i64();
1443
 
        TCGv_i64 hitmp = tcg_temp_new_i64();
1444
 
 
1445
 
        g_assert(size >= 2);
1446
 
        tcg_gen_addi_i64(addr2, addr, 1 << size);
1447
 
        tcg_gen_qemu_ld_i64(hitmp, addr2, get_mem_index(s), memop);
1448
 
        tcg_temp_free_i64(addr2);
1449
 
        tcg_gen_mov_i64(cpu_exclusive_high, hitmp);
1450
 
        tcg_gen_mov_i64(cpu_reg(s, rt2), hitmp);
1451
 
        tcg_temp_free_i64(hitmp);
1452
 
    }
1453
 
 
1454
 
    tcg_gen_mov_i64(cpu_exclusive_val, tmp);
1455
 
    tcg_gen_mov_i64(cpu_reg(s, rt), tmp);
1456
 
 
1457
 
    tcg_temp_free_i64(tmp);
1458
 
    tcg_gen_mov_i64(cpu_exclusive_addr, addr);
1459
 
}
1460
 
 
1461
 
#ifdef CONFIG_USER_ONLY
1462
 
static void gen_store_exclusive(DisasContext *s, int rd, int rt, int rt2,
1463
 
                                TCGv_i64 addr, int size, int is_pair)
1464
 
{
1465
 
    tcg_gen_mov_i64(cpu_exclusive_test, addr);
1466
 
    tcg_gen_movi_i32(cpu_exclusive_info,
1467
 
                     size | is_pair << 2 | (rd << 4) | (rt << 9) | (rt2 << 14));
1468
 
    gen_exception_insn(s, 4, EXCP_STREX);
1469
 
}
1470
 
#else
1471
 
static void gen_store_exclusive(DisasContext *s, int rd, int rt, int rt2,
1472
 
                                TCGv_i64 addr, int size, int is_pair)
1473
 
{
1474
 
    qemu_log_mask(LOG_UNIMP,
1475
 
                  "%s:%d: system mode store_exclusive unsupported "
1476
 
                  "at pc=%016" PRIx64 "\n",
1477
 
                  __FILE__, __LINE__, s->pc - 4);
1478
 
}
1479
 
#endif
1480
 
 
1481
 
/* C3.3.6 Load/store exclusive
1482
 
 *
1483
 
 *  31 30 29         24  23  22   21  20  16  15  14   10 9    5 4    0
1484
 
 * +-----+-------------+----+---+----+------+----+-------+------+------+
1485
 
 * | sz  | 0 0 1 0 0 0 | o2 | L | o1 |  Rs  | o0 |  Rt2  |  Rn  | Rt   |
1486
 
 * +-----+-------------+----+---+----+------+----+-------+------+------+
1487
 
 *
1488
 
 *  sz: 00 -> 8 bit, 01 -> 16 bit, 10 -> 32 bit, 11 -> 64 bit
1489
 
 *   L: 0 -> store, 1 -> load
1490
 
 *  o2: 0 -> exclusive, 1 -> not
1491
 
 *  o1: 0 -> single register, 1 -> register pair
1492
 
 *  o0: 1 -> load-acquire/store-release, 0 -> not
1493
 
 *
1494
 
 *  o0 == 0 AND o2 == 1 is un-allocated
1495
 
 *  o1 == 1 is un-allocated except for 32 and 64 bit sizes
1496
 
 */
1497
 
static void disas_ldst_excl(DisasContext *s, uint32_t insn)
1498
 
{
1499
 
    int rt = extract32(insn, 0, 5);
1500
 
    int rn = extract32(insn, 5, 5);
1501
 
    int rt2 = extract32(insn, 10, 5);
1502
 
    int is_lasr = extract32(insn, 15, 1);
1503
 
    int rs = extract32(insn, 16, 5);
1504
 
    int is_pair = extract32(insn, 21, 1);
1505
 
    int is_store = !extract32(insn, 22, 1);
1506
 
    int is_excl = !extract32(insn, 23, 1);
1507
 
    int size = extract32(insn, 30, 2);
1508
 
    TCGv_i64 tcg_addr;
1509
 
 
1510
 
    if ((!is_excl && !is_lasr) ||
1511
 
        (is_pair && size < 2)) {
1512
 
        unallocated_encoding(s);
1513
 
        return;
1514
 
    }
1515
 
 
1516
 
    if (rn == 31) {
1517
 
        gen_check_sp_alignment(s);
1518
 
    }
1519
 
    tcg_addr = read_cpu_reg_sp(s, rn, 1);
1520
 
 
1521
 
    /* Note that since TCG is single threaded load-acquire/store-release
1522
 
     * semantics require no extra if (is_lasr) { ... } handling.
1523
 
     */
1524
 
 
1525
 
    if (is_excl) {
1526
 
        if (!is_store) {
1527
 
            gen_load_exclusive(s, rt, rt2, tcg_addr, size, is_pair);
1528
 
        } else {
1529
 
            gen_store_exclusive(s, rs, rt, rt2, tcg_addr, size, is_pair);
1530
 
        }
1531
 
    } else {
1532
 
        TCGv_i64 tcg_rt = cpu_reg(s, rt);
1533
 
        if (is_store) {
1534
 
            do_gpr_st(s, tcg_rt, tcg_addr, size);
1535
 
        } else {
1536
 
            do_gpr_ld(s, tcg_rt, tcg_addr, size, false, false);
1537
 
        }
1538
 
        if (is_pair) {
1539
 
            TCGv_i64 tcg_rt2 = cpu_reg(s, rt);
1540
 
            tcg_gen_addi_i64(tcg_addr, tcg_addr, 1 << size);
1541
 
            if (is_store) {
1542
 
                do_gpr_st(s, tcg_rt2, tcg_addr, size);
1543
 
            } else {
1544
 
                do_gpr_ld(s, tcg_rt2, tcg_addr, size, false, false);
1545
 
            }
1546
 
        }
1547
 
    }
1548
 
}
1549
 
 
1550
 
/*
1551
 
 * C3.3.5 Load register (literal)
1552
 
 *
1553
 
 *  31 30 29   27  26 25 24 23                5 4     0
1554
 
 * +-----+-------+---+-----+-------------------+-------+
1555
 
 * | opc | 0 1 1 | V | 0 0 |     imm19         |  Rt   |
1556
 
 * +-----+-------+---+-----+-------------------+-------+
1557
 
 *
1558
 
 * V: 1 -> vector (simd/fp)
1559
 
 * opc (non-vector): 00 -> 32 bit, 01 -> 64 bit,
1560
 
 *                   10-> 32 bit signed, 11 -> prefetch
1561
 
 * opc (vector): 00 -> 32 bit, 01 -> 64 bit, 10 -> 128 bit (11 unallocated)
1562
 
 */
1563
 
static void disas_ld_lit(DisasContext *s, uint32_t insn)
1564
 
{
1565
 
    int rt = extract32(insn, 0, 5);
1566
 
    int64_t imm = sextract32(insn, 5, 19) << 2;
1567
 
    bool is_vector = extract32(insn, 26, 1);
1568
 
    int opc = extract32(insn, 30, 2);
1569
 
    bool is_signed = false;
1570
 
    int size = 2;
1571
 
    TCGv_i64 tcg_rt, tcg_addr;
1572
 
 
1573
 
    if (is_vector) {
1574
 
        if (opc == 3) {
1575
 
            unallocated_encoding(s);
1576
 
            return;
1577
 
        }
1578
 
        size = 2 + opc;
1579
 
    } else {
1580
 
        if (opc == 3) {
1581
 
            /* PRFM (literal) : prefetch */
1582
 
            return;
1583
 
        }
1584
 
        size = 2 + extract32(opc, 0, 1);
1585
 
        is_signed = extract32(opc, 1, 1);
1586
 
    }
1587
 
 
1588
 
    tcg_rt = cpu_reg(s, rt);
1589
 
 
1590
 
    tcg_addr = tcg_const_i64((s->pc - 4) + imm);
1591
 
    if (is_vector) {
1592
 
        do_fp_ld(s, rt, tcg_addr, size);
1593
 
    } else {
1594
 
        do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed, false);
1595
 
    }
1596
 
    tcg_temp_free_i64(tcg_addr);
1597
 
}
1598
 
 
1599
 
/*
1600
 
 * C5.6.80 LDNP (Load Pair - non-temporal hint)
1601
 
 * C5.6.81 LDP (Load Pair - non vector)
1602
 
 * C5.6.82 LDPSW (Load Pair Signed Word - non vector)
1603
 
 * C5.6.176 STNP (Store Pair - non-temporal hint)
1604
 
 * C5.6.177 STP (Store Pair - non vector)
1605
 
 * C6.3.165 LDNP (Load Pair of SIMD&FP - non-temporal hint)
1606
 
 * C6.3.165 LDP (Load Pair of SIMD&FP)
1607
 
 * C6.3.284 STNP (Store Pair of SIMD&FP - non-temporal hint)
1608
 
 * C6.3.284 STP (Store Pair of SIMD&FP)
1609
 
 *
1610
 
 *  31 30 29   27  26  25 24   23  22 21   15 14   10 9    5 4    0
1611
 
 * +-----+-------+---+---+-------+---+-----------------------------+
1612
 
 * | opc | 1 0 1 | V | 0 | index | L |  imm7 |  Rt2  |  Rn  | Rt   |
1613
 
 * +-----+-------+---+---+-------+---+-------+-------+------+------+
1614
 
 *
1615
 
 * opc: LDP/STP/LDNP/STNP        00 -> 32 bit, 10 -> 64 bit
1616
 
 *      LDPSW                    01
1617
 
 *      LDP/STP/LDNP/STNP (SIMD) 00 -> 32 bit, 01 -> 64 bit, 10 -> 128 bit
1618
 
 *   V: 0 -> GPR, 1 -> Vector
1619
 
 * idx: 00 -> signed offset with non-temporal hint, 01 -> post-index,
1620
 
 *      10 -> signed offset, 11 -> pre-index
1621
 
 *   L: 0 -> Store 1 -> Load
1622
 
 *
1623
 
 * Rt, Rt2 = GPR or SIMD registers to be stored
1624
 
 * Rn = general purpose register containing address
1625
 
 * imm7 = signed offset (multiple of 4 or 8 depending on size)
1626
 
 */
1627
 
static void disas_ldst_pair(DisasContext *s, uint32_t insn)
1628
 
{
1629
 
    int rt = extract32(insn, 0, 5);
1630
 
    int rn = extract32(insn, 5, 5);
1631
 
    int rt2 = extract32(insn, 10, 5);
1632
 
    int64_t offset = sextract32(insn, 15, 7);
1633
 
    int index = extract32(insn, 23, 2);
1634
 
    bool is_vector = extract32(insn, 26, 1);
1635
 
    bool is_load = extract32(insn, 22, 1);
1636
 
    int opc = extract32(insn, 30, 2);
1637
 
 
1638
 
    bool is_signed = false;
1639
 
    bool postindex = false;
1640
 
    bool wback = false;
1641
 
 
1642
 
    TCGv_i64 tcg_addr; /* calculated address */
1643
 
    int size;
1644
 
 
1645
 
    if (opc == 3) {
1646
 
        unallocated_encoding(s);
1647
 
        return;
1648
 
    }
1649
 
 
1650
 
    if (is_vector) {
1651
 
        size = 2 + opc;
1652
 
    } else {
1653
 
        size = 2 + extract32(opc, 1, 1);
1654
 
        is_signed = extract32(opc, 0, 1);
1655
 
        if (!is_load && is_signed) {
1656
 
            unallocated_encoding(s);
1657
 
            return;
1658
 
        }
1659
 
    }
1660
 
 
1661
 
    switch (index) {
1662
 
    case 1: /* post-index */
1663
 
        postindex = true;
1664
 
        wback = true;
1665
 
        break;
1666
 
    case 0:
1667
 
        /* signed offset with "non-temporal" hint. Since we don't emulate
1668
 
         * caches we don't care about hints to the cache system about
1669
 
         * data access patterns, and handle this identically to plain
1670
 
         * signed offset.
1671
 
         */
1672
 
        if (is_signed) {
1673
 
            /* There is no non-temporal-hint version of LDPSW */
1674
 
            unallocated_encoding(s);
1675
 
            return;
1676
 
        }
1677
 
        postindex = false;
1678
 
        break;
1679
 
    case 2: /* signed offset, rn not updated */
1680
 
        postindex = false;
1681
 
        break;
1682
 
    case 3: /* pre-index */
1683
 
        postindex = false;
1684
 
        wback = true;
1685
 
        break;
1686
 
    }
1687
 
 
1688
 
    offset <<= size;
1689
 
 
1690
 
    if (rn == 31) {
1691
 
        gen_check_sp_alignment(s);
1692
 
    }
1693
 
 
1694
 
    tcg_addr = read_cpu_reg_sp(s, rn, 1);
1695
 
 
1696
 
    if (!postindex) {
1697
 
        tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1698
 
    }
1699
 
 
1700
 
    if (is_vector) {
1701
 
        if (is_load) {
1702
 
            do_fp_ld(s, rt, tcg_addr, size);
1703
 
        } else {
1704
 
            do_fp_st(s, rt, tcg_addr, size);
1705
 
        }
1706
 
    } else {
1707
 
        TCGv_i64 tcg_rt = cpu_reg(s, rt);
1708
 
        if (is_load) {
1709
 
            do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed, false);
1710
 
        } else {
1711
 
            do_gpr_st(s, tcg_rt, tcg_addr, size);
1712
 
        }
1713
 
    }
1714
 
    tcg_gen_addi_i64(tcg_addr, tcg_addr, 1 << size);
1715
 
    if (is_vector) {
1716
 
        if (is_load) {
1717
 
            do_fp_ld(s, rt2, tcg_addr, size);
1718
 
        } else {
1719
 
            do_fp_st(s, rt2, tcg_addr, size);
1720
 
        }
1721
 
    } else {
1722
 
        TCGv_i64 tcg_rt2 = cpu_reg(s, rt2);
1723
 
        if (is_load) {
1724
 
            do_gpr_ld(s, tcg_rt2, tcg_addr, size, is_signed, false);
1725
 
        } else {
1726
 
            do_gpr_st(s, tcg_rt2, tcg_addr, size);
1727
 
        }
1728
 
    }
1729
 
 
1730
 
    if (wback) {
1731
 
        if (postindex) {
1732
 
            tcg_gen_addi_i64(tcg_addr, tcg_addr, offset - (1 << size));
1733
 
        } else {
1734
 
            tcg_gen_subi_i64(tcg_addr, tcg_addr, 1 << size);
1735
 
        }
1736
 
        tcg_gen_mov_i64(cpu_reg_sp(s, rn), tcg_addr);
1737
 
    }
1738
 
}
1739
 
 
1740
 
/*
1741
 
 * C3.3.8 Load/store (immediate post-indexed)
1742
 
 * C3.3.9 Load/store (immediate pre-indexed)
1743
 
 * C3.3.12 Load/store (unscaled immediate)
1744
 
 *
1745
 
 * 31 30 29   27  26 25 24 23 22 21  20    12 11 10 9    5 4    0
1746
 
 * +----+-------+---+-----+-----+---+--------+-----+------+------+
1747
 
 * |size| 1 1 1 | V | 0 0 | opc | 0 |  imm9  | idx |  Rn  |  Rt  |
1748
 
 * +----+-------+---+-----+-----+---+--------+-----+------+------+
1749
 
 *
1750
 
 * idx = 01 -> post-indexed, 11 pre-indexed, 00 unscaled imm. (no writeback)
1751
 
 * V = 0 -> non-vector
1752
 
 * size: 00 -> 8 bit, 01 -> 16 bit, 10 -> 32 bit, 11 -> 64bit
1753
 
 * opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1754
 
 */
1755
 
static void disas_ldst_reg_imm9(DisasContext *s, uint32_t insn)
1756
 
{
1757
 
    int rt = extract32(insn, 0, 5);
1758
 
    int rn = extract32(insn, 5, 5);
1759
 
    int imm9 = sextract32(insn, 12, 9);
1760
 
    int opc = extract32(insn, 22, 2);
1761
 
    int size = extract32(insn, 30, 2);
1762
 
    int idx = extract32(insn, 10, 2);
1763
 
    bool is_signed = false;
1764
 
    bool is_store = false;
1765
 
    bool is_extended = false;
1766
 
    bool is_vector = extract32(insn, 26, 1);
1767
 
    bool post_index;
1768
 
    bool writeback;
1769
 
 
1770
 
    TCGv_i64 tcg_addr;
1771
 
 
1772
 
    if (is_vector) {
1773
 
        size |= (opc & 2) << 1;
1774
 
        if (size > 4) {
1775
 
            unallocated_encoding(s);
1776
 
            return;
1777
 
        }
1778
 
        is_store = ((opc & 1) == 0);
1779
 
    } else {
1780
 
        if (size == 3 && opc == 2) {
1781
 
            /* PRFM - prefetch */
1782
 
            return;
1783
 
        }
1784
 
        if (opc == 3 && size > 1) {
1785
 
            unallocated_encoding(s);
1786
 
            return;
1787
 
        }
1788
 
        is_store = (opc == 0);
1789
 
        is_signed = opc & (1<<1);
1790
 
        is_extended = (size < 3) && (opc & 1);
1791
 
    }
1792
 
 
1793
 
    switch (idx) {
1794
 
    case 0:
1795
 
        post_index = false;
1796
 
        writeback = false;
1797
 
        break;
1798
 
    case 1:
1799
 
        post_index = true;
1800
 
        writeback = true;
1801
 
        break;
1802
 
    case 3:
1803
 
        post_index = false;
1804
 
        writeback = true;
1805
 
        break;
1806
 
    case 2:
1807
 
        g_assert(false);
1808
 
        break;
1809
 
    }
1810
 
 
1811
 
    if (rn == 31) {
1812
 
        gen_check_sp_alignment(s);
1813
 
    }
1814
 
    tcg_addr = read_cpu_reg_sp(s, rn, 1);
1815
 
 
1816
 
    if (!post_index) {
1817
 
        tcg_gen_addi_i64(tcg_addr, tcg_addr, imm9);
1818
 
    }
1819
 
 
1820
 
    if (is_vector) {
1821
 
        if (is_store) {
1822
 
            do_fp_st(s, rt, tcg_addr, size);
1823
 
        } else {
1824
 
            do_fp_ld(s, rt, tcg_addr, size);
1825
 
        }
1826
 
    } else {
1827
 
        TCGv_i64 tcg_rt = cpu_reg(s, rt);
1828
 
        if (is_store) {
1829
 
            do_gpr_st(s, tcg_rt, tcg_addr, size);
1830
 
        } else {
1831
 
            do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed, is_extended);
1832
 
        }
1833
 
    }
1834
 
 
1835
 
    if (writeback) {
1836
 
        TCGv_i64 tcg_rn = cpu_reg_sp(s, rn);
1837
 
        if (post_index) {
1838
 
            tcg_gen_addi_i64(tcg_addr, tcg_addr, imm9);
1839
 
        }
1840
 
        tcg_gen_mov_i64(tcg_rn, tcg_addr);
1841
 
    }
1842
 
}
1843
 
 
1844
 
/*
1845
 
 * C3.3.10 Load/store (register offset)
1846
 
 *
1847
 
 * 31 30 29   27  26 25 24 23 22 21  20  16 15 13 12 11 10 9  5 4  0
1848
 
 * +----+-------+---+-----+-----+---+------+-----+--+-----+----+----+
1849
 
 * |size| 1 1 1 | V | 0 0 | opc | 1 |  Rm  | opt | S| 1 0 | Rn | Rt |
1850
 
 * +----+-------+---+-----+-----+---+------+-----+--+-----+----+----+
1851
 
 *
1852
 
 * For non-vector:
1853
 
 *   size: 00-> byte, 01 -> 16 bit, 10 -> 32bit, 11 -> 64bit
1854
 
 *   opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1855
 
 * For vector:
1856
 
 *   size is opc<1>:size<1:0> so 100 -> 128 bit; 110 and 111 unallocated
1857
 
 *   opc<0>: 0 -> store, 1 -> load
1858
 
 * V: 1 -> vector/simd
1859
 
 * opt: extend encoding (see DecodeRegExtend)
1860
 
 * S: if S=1 then scale (essentially index by sizeof(size))
1861
 
 * Rt: register to transfer into/out of
1862
 
 * Rn: address register or SP for base
1863
 
 * Rm: offset register or ZR for offset
1864
 
 */
1865
 
static void disas_ldst_reg_roffset(DisasContext *s, uint32_t insn)
1866
 
{
1867
 
    int rt = extract32(insn, 0, 5);
1868
 
    int rn = extract32(insn, 5, 5);
1869
 
    int shift = extract32(insn, 12, 1);
1870
 
    int rm = extract32(insn, 16, 5);
1871
 
    int opc = extract32(insn, 22, 2);
1872
 
    int opt = extract32(insn, 13, 3);
1873
 
    int size = extract32(insn, 30, 2);
1874
 
    bool is_signed = false;
1875
 
    bool is_store = false;
1876
 
    bool is_extended = false;
1877
 
    bool is_vector = extract32(insn, 26, 1);
1878
 
 
1879
 
    TCGv_i64 tcg_rm;
1880
 
    TCGv_i64 tcg_addr;
1881
 
 
1882
 
    if (extract32(opt, 1, 1) == 0) {
1883
 
        unallocated_encoding(s);
1884
 
        return;
1885
 
    }
1886
 
 
1887
 
    if (is_vector) {
1888
 
        size |= (opc & 2) << 1;
1889
 
        if (size > 4) {
1890
 
            unallocated_encoding(s);
1891
 
            return;
1892
 
        }
1893
 
        is_store = !extract32(opc, 0, 1);
1894
 
    } else {
1895
 
        if (size == 3 && opc == 2) {
1896
 
            /* PRFM - prefetch */
1897
 
            return;
1898
 
        }
1899
 
        if (opc == 3 && size > 1) {
1900
 
            unallocated_encoding(s);
1901
 
            return;
1902
 
        }
1903
 
        is_store = (opc == 0);
1904
 
        is_signed = extract32(opc, 1, 1);
1905
 
        is_extended = (size < 3) && extract32(opc, 0, 1);
1906
 
    }
1907
 
 
1908
 
    if (rn == 31) {
1909
 
        gen_check_sp_alignment(s);
1910
 
    }
1911
 
    tcg_addr = read_cpu_reg_sp(s, rn, 1);
1912
 
 
1913
 
    tcg_rm = read_cpu_reg(s, rm, 1);
1914
 
    ext_and_shift_reg(tcg_rm, tcg_rm, opt, shift ? size : 0);
1915
 
 
1916
 
    tcg_gen_add_i64(tcg_addr, tcg_addr, tcg_rm);
1917
 
 
1918
 
    if (is_vector) {
1919
 
        if (is_store) {
1920
 
            do_fp_st(s, rt, tcg_addr, size);
1921
 
        } else {
1922
 
            do_fp_ld(s, rt, tcg_addr, size);
1923
 
        }
1924
 
    } else {
1925
 
        TCGv_i64 tcg_rt = cpu_reg(s, rt);
1926
 
        if (is_store) {
1927
 
            do_gpr_st(s, tcg_rt, tcg_addr, size);
1928
 
        } else {
1929
 
            do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed, is_extended);
1930
 
        }
1931
 
    }
1932
 
}
1933
 
 
1934
 
/*
1935
 
 * C3.3.13 Load/store (unsigned immediate)
1936
 
 *
1937
 
 * 31 30 29   27  26 25 24 23 22 21        10 9     5
1938
 
 * +----+-------+---+-----+-----+------------+-------+------+
1939
 
 * |size| 1 1 1 | V | 0 1 | opc |   imm12    |  Rn   |  Rt  |
1940
 
 * +----+-------+---+-----+-----+------------+-------+------+
1941
 
 *
1942
 
 * For non-vector:
1943
 
 *   size: 00-> byte, 01 -> 16 bit, 10 -> 32bit, 11 -> 64bit
1944
 
 *   opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1945
 
 * For vector:
1946
 
 *   size is opc<1>:size<1:0> so 100 -> 128 bit; 110 and 111 unallocated
1947
 
 *   opc<0>: 0 -> store, 1 -> load
1948
 
 * Rn: base address register (inc SP)
1949
 
 * Rt: target register
1950
 
 */
1951
 
static void disas_ldst_reg_unsigned_imm(DisasContext *s, uint32_t insn)
1952
 
{
1953
 
    int rt = extract32(insn, 0, 5);
1954
 
    int rn = extract32(insn, 5, 5);
1955
 
    unsigned int imm12 = extract32(insn, 10, 12);
1956
 
    bool is_vector = extract32(insn, 26, 1);
1957
 
    int size = extract32(insn, 30, 2);
1958
 
    int opc = extract32(insn, 22, 2);
1959
 
    unsigned int offset;
1960
 
 
1961
 
    TCGv_i64 tcg_addr;
1962
 
 
1963
 
    bool is_store;
1964
 
    bool is_signed = false;
1965
 
    bool is_extended = false;
1966
 
 
1967
 
    if (is_vector) {
1968
 
        size |= (opc & 2) << 1;
1969
 
        if (size > 4) {
1970
 
            unallocated_encoding(s);
1971
 
            return;
1972
 
        }
1973
 
        is_store = !extract32(opc, 0, 1);
1974
 
    } else {
1975
 
        if (size == 3 && opc == 2) {
1976
 
            /* PRFM - prefetch */
1977
 
            return;
1978
 
        }
1979
 
        if (opc == 3 && size > 1) {
1980
 
            unallocated_encoding(s);
1981
 
            return;
1982
 
        }
1983
 
        is_store = (opc == 0);
1984
 
        is_signed = extract32(opc, 1, 1);
1985
 
        is_extended = (size < 3) && extract32(opc, 0, 1);
1986
 
    }
1987
 
 
1988
 
    if (rn == 31) {
1989
 
        gen_check_sp_alignment(s);
1990
 
    }
1991
 
    tcg_addr = read_cpu_reg_sp(s, rn, 1);
1992
 
    offset = imm12 << size;
1993
 
    tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1994
 
 
1995
 
    if (is_vector) {
1996
 
        if (is_store) {
1997
 
            do_fp_st(s, rt, tcg_addr, size);
1998
 
        } else {
1999
 
            do_fp_ld(s, rt, tcg_addr, size);
2000
 
        }
2001
 
    } else {
2002
 
        TCGv_i64 tcg_rt = cpu_reg(s, rt);
2003
 
        if (is_store) {
2004
 
            do_gpr_st(s, tcg_rt, tcg_addr, size);
2005
 
        } else {
2006
 
            do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed, is_extended);
2007
 
        }
2008
 
    }
2009
 
}
2010
 
 
2011
 
/* Load/store register (immediate forms) */
2012
 
static void disas_ldst_reg_imm(DisasContext *s, uint32_t insn)
2013
 
{
2014
 
    switch (extract32(insn, 10, 2)) {
2015
 
    case 0: case 1: case 3:
2016
 
        /* Load/store register (unscaled immediate) */
2017
 
        /* Load/store immediate pre/post-indexed */
2018
 
        disas_ldst_reg_imm9(s, insn);
2019
 
        break;
2020
 
    case 2:
2021
 
        /* Load/store register unprivileged */
2022
 
        unsupported_encoding(s, insn);
2023
 
        break;
2024
 
    default:
2025
 
        unallocated_encoding(s);
2026
 
        break;
2027
 
    }
2028
 
}
2029
 
 
2030
 
/* Load/store register (all forms) */
2031
 
static void disas_ldst_reg(DisasContext *s, uint32_t insn)
2032
 
{
2033
 
    switch (extract32(insn, 24, 2)) {
2034
 
    case 0:
2035
 
        if (extract32(insn, 21, 1) == 1 && extract32(insn, 10, 2) == 2) {
2036
 
            disas_ldst_reg_roffset(s, insn);
2037
 
        } else {
2038
 
            disas_ldst_reg_imm(s, insn);
2039
 
        }
2040
 
        break;
2041
 
    case 1:
2042
 
        disas_ldst_reg_unsigned_imm(s, insn);
2043
 
        break;
2044
 
    default:
2045
 
        unallocated_encoding(s);
2046
 
        break;
2047
 
    }
2048
 
}
2049
 
 
2050
 
/* C3.3.1 AdvSIMD load/store multiple structures
2051
 
 *
2052
 
 *  31  30  29           23 22  21         16 15    12 11  10 9    5 4    0
2053
 
 * +---+---+---------------+---+-------------+--------+------+------+------+
2054
 
 * | 0 | Q | 0 0 1 1 0 0 0 | L | 0 0 0 0 0 0 | opcode | size |  Rn  |  Rt  |
2055
 
 * +---+---+---------------+---+-------------+--------+------+------+------+
2056
 
 *
2057
 
 * C3.3.2 AdvSIMD load/store multiple structures (post-indexed)
2058
 
 *
2059
 
 *  31  30  29           23 22  21  20     16 15    12 11  10 9    5 4    0
2060
 
 * +---+---+---------------+---+---+---------+--------+------+------+------+
2061
 
 * | 0 | Q | 0 0 1 1 0 0 1 | L | 0 |   Rm    | opcode | size |  Rn  |  Rt  |
2062
 
 * +---+---+---------------+---+---+---------+--------+------+------+------+
2063
 
 *
2064
 
 * Rt: first (or only) SIMD&FP register to be transferred
2065
 
 * Rn: base address or SP
2066
 
 * Rm (post-index only): post-index register (when !31) or size dependent #imm
2067
 
 */
2068
 
static void disas_ldst_multiple_struct(DisasContext *s, uint32_t insn)
2069
 
{
2070
 
    int rt = extract32(insn, 0, 5);
2071
 
    int rn = extract32(insn, 5, 5);
2072
 
    int size = extract32(insn, 10, 2);
2073
 
    int opcode = extract32(insn, 12, 4);
2074
 
    bool is_store = !extract32(insn, 22, 1);
2075
 
    bool is_postidx = extract32(insn, 23, 1);
2076
 
    bool is_q = extract32(insn, 30, 1);
2077
 
    TCGv_i64 tcg_addr, tcg_rn;
2078
 
 
2079
 
    int ebytes = 1 << size;
2080
 
    int elements = (is_q ? 128 : 64) / (8 << size);
2081
 
    int rpt;    /* num iterations */
2082
 
    int selem;  /* structure elements */
2083
 
    int r;
2084
 
 
2085
 
    if (extract32(insn, 31, 1) || extract32(insn, 21, 1)) {
2086
 
        unallocated_encoding(s);
2087
 
        return;
2088
 
    }
2089
 
 
2090
 
    /* From the shared decode logic */
2091
 
    switch (opcode) {
2092
 
    case 0x0:
2093
 
        rpt = 1;
2094
 
        selem = 4;
2095
 
        break;
2096
 
    case 0x2:
2097
 
        rpt = 4;
2098
 
        selem = 1;
2099
 
        break;
2100
 
    case 0x4:
2101
 
        rpt = 1;
2102
 
        selem = 3;
2103
 
        break;
2104
 
    case 0x6:
2105
 
        rpt = 3;
2106
 
        selem = 1;
2107
 
        break;
2108
 
    case 0x7:
2109
 
        rpt = 1;
2110
 
        selem = 1;
2111
 
        break;
2112
 
    case 0x8:
2113
 
        rpt = 1;
2114
 
        selem = 2;
2115
 
        break;
2116
 
    case 0xa:
2117
 
        rpt = 2;
2118
 
        selem = 1;
2119
 
        break;
2120
 
    default:
2121
 
        unallocated_encoding(s);
2122
 
        return;
2123
 
    }
2124
 
 
2125
 
    if (size == 3 && !is_q && selem != 1) {
2126
 
        /* reserved */
2127
 
        unallocated_encoding(s);
2128
 
        return;
2129
 
    }
2130
 
 
2131
 
    if (rn == 31) {
2132
 
        gen_check_sp_alignment(s);
2133
 
    }
2134
 
 
2135
 
    tcg_rn = cpu_reg_sp(s, rn);
2136
 
    tcg_addr = tcg_temp_new_i64();
2137
 
    tcg_gen_mov_i64(tcg_addr, tcg_rn);
2138
 
 
2139
 
    for (r = 0; r < rpt; r++) {
2140
 
        int e;
2141
 
        for (e = 0; e < elements; e++) {
2142
 
            int tt = (rt + r) % 32;
2143
 
            int xs;
2144
 
            for (xs = 0; xs < selem; xs++) {
2145
 
                if (is_store) {
2146
 
                    do_vec_st(s, tt, e, tcg_addr, size);
2147
 
                } else {
2148
 
                    do_vec_ld(s, tt, e, tcg_addr, size);
2149
 
 
2150
 
                    /* For non-quad operations, setting a slice of the low
2151
 
                     * 64 bits of the register clears the high 64 bits (in
2152
 
                     * the ARM ARM pseudocode this is implicit in the fact
2153
 
                     * that 'rval' is a 64 bit wide variable). We optimize
2154
 
                     * by noticing that we only need to do this the first
2155
 
                     * time we touch a register.
2156
 
                     */
2157
 
                    if (!is_q && e == 0 && (r == 0 || xs == selem - 1)) {
2158
 
                        clear_vec_high(s, tt);
2159
 
                    }
2160
 
                }
2161
 
                tcg_gen_addi_i64(tcg_addr, tcg_addr, ebytes);
2162
 
                tt = (tt + 1) % 32;
2163
 
            }
2164
 
        }
2165
 
    }
2166
 
 
2167
 
    if (is_postidx) {
2168
 
        int rm = extract32(insn, 16, 5);
2169
 
        if (rm == 31) {
2170
 
            tcg_gen_mov_i64(tcg_rn, tcg_addr);
2171
 
        } else {
2172
 
            tcg_gen_add_i64(tcg_rn, tcg_rn, cpu_reg(s, rm));
2173
 
        }
2174
 
    }
2175
 
    tcg_temp_free_i64(tcg_addr);
2176
 
}
2177
 
 
2178
 
/* C3.3.3 AdvSIMD load/store single structure
2179
 
 *
2180
 
 *  31  30  29           23 22 21 20       16 15 13 12  11  10 9    5 4    0
2181
 
 * +---+---+---------------+-----+-----------+-----+---+------+------+------+
2182
 
 * | 0 | Q | 0 0 1 1 0 1 0 | L R | 0 0 0 0 0 | opc | S | size |  Rn  |  Rt  |
2183
 
 * +---+---+---------------+-----+-----------+-----+---+------+------+------+
2184
 
 *
2185
 
 * C3.3.4 AdvSIMD load/store single structure (post-indexed)
2186
 
 *
2187
 
 *  31  30  29           23 22 21 20       16 15 13 12  11  10 9    5 4    0
2188
 
 * +---+---+---------------+-----+-----------+-----+---+------+------+------+
2189
 
 * | 0 | Q | 0 0 1 1 0 1 1 | L R |     Rm    | opc | S | size |  Rn  |  Rt  |
2190
 
 * +---+---+---------------+-----+-----------+-----+---+------+------+------+
2191
 
 *
2192
 
 * Rt: first (or only) SIMD&FP register to be transferred
2193
 
 * Rn: base address or SP
2194
 
 * Rm (post-index only): post-index register (when !31) or size dependent #imm
2195
 
 * index = encoded in Q:S:size dependent on size
2196
 
 *
2197
 
 * lane_size = encoded in R, opc
2198
 
 * transfer width = encoded in opc, S, size
2199
 
 */
2200
 
static void disas_ldst_single_struct(DisasContext *s, uint32_t insn)
2201
 
{
2202
 
    int rt = extract32(insn, 0, 5);
2203
 
    int rn = extract32(insn, 5, 5);
2204
 
    int size = extract32(insn, 10, 2);
2205
 
    int S = extract32(insn, 12, 1);
2206
 
    int opc = extract32(insn, 13, 3);
2207
 
    int R = extract32(insn, 21, 1);
2208
 
    int is_load = extract32(insn, 22, 1);
2209
 
    int is_postidx = extract32(insn, 23, 1);
2210
 
    int is_q = extract32(insn, 30, 1);
2211
 
 
2212
 
    int scale = extract32(opc, 1, 2);
2213
 
    int selem = (extract32(opc, 0, 1) << 1 | R) + 1;
2214
 
    bool replicate = false;
2215
 
    int index = is_q << 3 | S << 2 | size;
2216
 
    int ebytes, xs;
2217
 
    TCGv_i64 tcg_addr, tcg_rn;
2218
 
 
2219
 
    switch (scale) {
2220
 
    case 3:
2221
 
        if (!is_load || S) {
2222
 
            unallocated_encoding(s);
2223
 
            return;
2224
 
        }
2225
 
        scale = size;
2226
 
        replicate = true;
2227
 
        break;
2228
 
    case 0:
2229
 
        break;
2230
 
    case 1:
2231
 
        if (extract32(size, 0, 1)) {
2232
 
            unallocated_encoding(s);
2233
 
            return;
2234
 
        }
2235
 
        index >>= 1;
2236
 
        break;
2237
 
    case 2:
2238
 
        if (extract32(size, 1, 1)) {
2239
 
            unallocated_encoding(s);
2240
 
            return;
2241
 
        }
2242
 
        if (!extract32(size, 0, 1)) {
2243
 
            index >>= 2;
2244
 
        } else {
2245
 
            if (S) {
2246
 
                unallocated_encoding(s);
2247
 
                return;
2248
 
            }
2249
 
            index >>= 3;
2250
 
            scale = 3;
2251
 
        }
2252
 
        break;
2253
 
    default:
2254
 
        g_assert_not_reached();
2255
 
    }
2256
 
 
2257
 
    ebytes = 1 << scale;
2258
 
 
2259
 
    if (rn == 31) {
2260
 
        gen_check_sp_alignment(s);
2261
 
    }
2262
 
 
2263
 
    tcg_rn = cpu_reg_sp(s, rn);
2264
 
    tcg_addr = tcg_temp_new_i64();
2265
 
    tcg_gen_mov_i64(tcg_addr, tcg_rn);
2266
 
 
2267
 
    for (xs = 0; xs < selem; xs++) {
2268
 
        if (replicate) {
2269
 
            /* Load and replicate to all elements */
2270
 
            uint64_t mulconst;
2271
 
            TCGv_i64 tcg_tmp = tcg_temp_new_i64();
2272
 
 
2273
 
            tcg_gen_qemu_ld_i64(tcg_tmp, tcg_addr,
2274
 
                                get_mem_index(s), MO_TE + scale);
2275
 
            switch (scale) {
2276
 
            case 0:
2277
 
                mulconst = 0x0101010101010101ULL;
2278
 
                break;
2279
 
            case 1:
2280
 
                mulconst = 0x0001000100010001ULL;
2281
 
                break;
2282
 
            case 2:
2283
 
                mulconst = 0x0000000100000001ULL;
2284
 
                break;
2285
 
            case 3:
2286
 
                mulconst = 0;
2287
 
                break;
2288
 
            default:
2289
 
                g_assert_not_reached();
2290
 
            }
2291
 
            if (mulconst) {
2292
 
                tcg_gen_muli_i64(tcg_tmp, tcg_tmp, mulconst);
2293
 
            }
2294
 
            write_vec_element(s, tcg_tmp, rt, 0, MO_64);
2295
 
            if (is_q) {
2296
 
                write_vec_element(s, tcg_tmp, rt, 1, MO_64);
2297
 
            } else {
2298
 
                clear_vec_high(s, rt);
2299
 
            }
2300
 
            tcg_temp_free_i64(tcg_tmp);
2301
 
        } else {
2302
 
            /* Load/store one element per register */
2303
 
            if (is_load) {
2304
 
                do_vec_ld(s, rt, index, tcg_addr, MO_TE + scale);
2305
 
            } else {
2306
 
                do_vec_st(s, rt, index, tcg_addr, MO_TE + scale);
2307
 
            }
2308
 
        }
2309
 
        tcg_gen_addi_i64(tcg_addr, tcg_addr, ebytes);
2310
 
        rt = (rt + 1) % 32;
2311
 
    }
2312
 
 
2313
 
    if (is_postidx) {
2314
 
        int rm = extract32(insn, 16, 5);
2315
 
        if (rm == 31) {
2316
 
            tcg_gen_mov_i64(tcg_rn, tcg_addr);
2317
 
        } else {
2318
 
            tcg_gen_add_i64(tcg_rn, tcg_rn, cpu_reg(s, rm));
2319
 
        }
2320
 
    }
2321
 
    tcg_temp_free_i64(tcg_addr);
2322
 
}
2323
 
 
2324
 
/* C3.3 Loads and stores */
2325
 
static void disas_ldst(DisasContext *s, uint32_t insn)
2326
 
{
2327
 
    switch (extract32(insn, 24, 6)) {
2328
 
    case 0x08: /* Load/store exclusive */
2329
 
        disas_ldst_excl(s, insn);
2330
 
        break;
2331
 
    case 0x18: case 0x1c: /* Load register (literal) */
2332
 
        disas_ld_lit(s, insn);
2333
 
        break;
2334
 
    case 0x28: case 0x29:
2335
 
    case 0x2c: case 0x2d: /* Load/store pair (all forms) */
2336
 
        disas_ldst_pair(s, insn);
2337
 
        break;
2338
 
    case 0x38: case 0x39:
2339
 
    case 0x3c: case 0x3d: /* Load/store register (all forms) */
2340
 
        disas_ldst_reg(s, insn);
2341
 
        break;
2342
 
    case 0x0c: /* AdvSIMD load/store multiple structures */
2343
 
        disas_ldst_multiple_struct(s, insn);
2344
 
        break;
2345
 
    case 0x0d: /* AdvSIMD load/store single structure */
2346
 
        disas_ldst_single_struct(s, insn);
2347
 
        break;
2348
 
    default:
2349
 
        unallocated_encoding(s);
2350
 
        break;
2351
 
    }
2352
 
}
2353
 
 
2354
 
/* C3.4.6 PC-rel. addressing
2355
 
 *   31  30   29 28       24 23                5 4    0
2356
 
 * +----+-------+-----------+-------------------+------+
2357
 
 * | op | immlo | 1 0 0 0 0 |       immhi       |  Rd  |
2358
 
 * +----+-------+-----------+-------------------+------+
2359
 
 */
2360
 
static void disas_pc_rel_adr(DisasContext *s, uint32_t insn)
2361
 
{
2362
 
    unsigned int page, rd;
2363
 
    uint64_t base;
2364
 
    int64_t offset;
2365
 
 
2366
 
    page = extract32(insn, 31, 1);
2367
 
    /* SignExtend(immhi:immlo) -> offset */
2368
 
    offset = ((int64_t)sextract32(insn, 5, 19) << 2) | extract32(insn, 29, 2);
2369
 
    rd = extract32(insn, 0, 5);
2370
 
    base = s->pc - 4;
2371
 
 
2372
 
    if (page) {
2373
 
        /* ADRP (page based) */
2374
 
        base &= ~0xfff;
2375
 
        offset <<= 12;
2376
 
    }
2377
 
 
2378
 
    tcg_gen_movi_i64(cpu_reg(s, rd), base + offset);
2379
 
}
2380
 
 
2381
 
/*
2382
 
 * C3.4.1 Add/subtract (immediate)
2383
 
 *
2384
 
 *  31 30 29 28       24 23 22 21         10 9   5 4   0
2385
 
 * +--+--+--+-----------+-----+-------------+-----+-----+
2386
 
 * |sf|op| S| 1 0 0 0 1 |shift|    imm12    |  Rn | Rd  |
2387
 
 * +--+--+--+-----------+-----+-------------+-----+-----+
2388
 
 *
2389
 
 *    sf: 0 -> 32bit, 1 -> 64bit
2390
 
 *    op: 0 -> add  , 1 -> sub
2391
 
 *     S: 1 -> set flags
2392
 
 * shift: 00 -> LSL imm by 0, 01 -> LSL imm by 12
2393
 
 */
2394
 
static void disas_add_sub_imm(DisasContext *s, uint32_t insn)
2395
 
{
2396
 
    int rd = extract32(insn, 0, 5);
2397
 
    int rn = extract32(insn, 5, 5);
2398
 
    uint64_t imm = extract32(insn, 10, 12);
2399
 
    int shift = extract32(insn, 22, 2);
2400
 
    bool setflags = extract32(insn, 29, 1);
2401
 
    bool sub_op = extract32(insn, 30, 1);
2402
 
    bool is_64bit = extract32(insn, 31, 1);
2403
 
 
2404
 
    TCGv_i64 tcg_rn = cpu_reg_sp(s, rn);
2405
 
    TCGv_i64 tcg_rd = setflags ? cpu_reg(s, rd) : cpu_reg_sp(s, rd);
2406
 
    TCGv_i64 tcg_result;
2407
 
 
2408
 
    switch (shift) {
2409
 
    case 0x0:
2410
 
        break;
2411
 
    case 0x1:
2412
 
        imm <<= 12;
2413
 
        break;
2414
 
    default:
2415
 
        unallocated_encoding(s);
2416
 
        return;
2417
 
    }
2418
 
 
2419
 
    tcg_result = tcg_temp_new_i64();
2420
 
    if (!setflags) {
2421
 
        if (sub_op) {
2422
 
            tcg_gen_subi_i64(tcg_result, tcg_rn, imm);
2423
 
        } else {
2424
 
            tcg_gen_addi_i64(tcg_result, tcg_rn, imm);
2425
 
        }
2426
 
    } else {
2427
 
        TCGv_i64 tcg_imm = tcg_const_i64(imm);
2428
 
        if (sub_op) {
2429
 
            gen_sub_CC(is_64bit, tcg_result, tcg_rn, tcg_imm);
2430
 
        } else {
2431
 
            gen_add_CC(is_64bit, tcg_result, tcg_rn, tcg_imm);
2432
 
        }
2433
 
        tcg_temp_free_i64(tcg_imm);
2434
 
    }
2435
 
 
2436
 
    if (is_64bit) {
2437
 
        tcg_gen_mov_i64(tcg_rd, tcg_result);
2438
 
    } else {
2439
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_result);
2440
 
    }
2441
 
 
2442
 
    tcg_temp_free_i64(tcg_result);
2443
 
}
2444
 
 
2445
 
/* The input should be a value in the bottom e bits (with higher
2446
 
 * bits zero); returns that value replicated into every element
2447
 
 * of size e in a 64 bit integer.
2448
 
 */
2449
 
static uint64_t bitfield_replicate(uint64_t mask, unsigned int e)
2450
 
{
2451
 
    assert(e != 0);
2452
 
    while (e < 64) {
2453
 
        mask |= mask << e;
2454
 
        e *= 2;
2455
 
    }
2456
 
    return mask;
2457
 
}
2458
 
 
2459
 
/* Return a value with the bottom len bits set (where 0 < len <= 64) */
2460
 
static inline uint64_t bitmask64(unsigned int length)
2461
 
{
2462
 
    assert(length > 0 && length <= 64);
2463
 
    return ~0ULL >> (64 - length);
2464
 
}
2465
 
 
2466
 
/* Simplified variant of pseudocode DecodeBitMasks() for the case where we
2467
 
 * only require the wmask. Returns false if the imms/immr/immn are a reserved
2468
 
 * value (ie should cause a guest UNDEF exception), and true if they are
2469
 
 * valid, in which case the decoded bit pattern is written to result.
2470
 
 */
2471
 
static bool logic_imm_decode_wmask(uint64_t *result, unsigned int immn,
2472
 
                                   unsigned int imms, unsigned int immr)
2473
 
{
2474
 
    uint64_t mask;
2475
 
    unsigned e, levels, s, r;
2476
 
    int len;
2477
 
 
2478
 
    assert(immn < 2 && imms < 64 && immr < 64);
2479
 
 
2480
 
    /* The bit patterns we create here are 64 bit patterns which
2481
 
     * are vectors of identical elements of size e = 2, 4, 8, 16, 32 or
2482
 
     * 64 bits each. Each element contains the same value: a run
2483
 
     * of between 1 and e-1 non-zero bits, rotated within the
2484
 
     * element by between 0 and e-1 bits.
2485
 
     *
2486
 
     * The element size and run length are encoded into immn (1 bit)
2487
 
     * and imms (6 bits) as follows:
2488
 
     * 64 bit elements: immn = 1, imms = <length of run - 1>
2489
 
     * 32 bit elements: immn = 0, imms = 0 : <length of run - 1>
2490
 
     * 16 bit elements: immn = 0, imms = 10 : <length of run - 1>
2491
 
     *  8 bit elements: immn = 0, imms = 110 : <length of run - 1>
2492
 
     *  4 bit elements: immn = 0, imms = 1110 : <length of run - 1>
2493
 
     *  2 bit elements: immn = 0, imms = 11110 : <length of run - 1>
2494
 
     * Notice that immn = 0, imms = 11111x is the only combination
2495
 
     * not covered by one of the above options; this is reserved.
2496
 
     * Further, <length of run - 1> all-ones is a reserved pattern.
2497
 
     *
2498
 
     * In all cases the rotation is by immr % e (and immr is 6 bits).
2499
 
     */
2500
 
 
2501
 
    /* First determine the element size */
2502
 
    len = 31 - clz32((immn << 6) | (~imms & 0x3f));
2503
 
    if (len < 1) {
2504
 
        /* This is the immn == 0, imms == 0x11111x case */
2505
 
        return false;
2506
 
    }
2507
 
    e = 1 << len;
2508
 
 
2509
 
    levels = e - 1;
2510
 
    s = imms & levels;
2511
 
    r = immr & levels;
2512
 
 
2513
 
    if (s == levels) {
2514
 
        /* <length of run - 1> mustn't be all-ones. */
2515
 
        return false;
2516
 
    }
2517
 
 
2518
 
    /* Create the value of one element: s+1 set bits rotated
2519
 
     * by r within the element (which is e bits wide)...
2520
 
     */
2521
 
    mask = bitmask64(s + 1);
2522
 
    mask = (mask >> r) | (mask << (e - r));
2523
 
    /* ...then replicate the element over the whole 64 bit value */
2524
 
    mask = bitfield_replicate(mask, e);
2525
 
    *result = mask;
2526
 
    return true;
2527
 
}
2528
 
 
2529
 
/* C3.4.4 Logical (immediate)
2530
 
 *   31  30 29 28         23 22  21  16 15  10 9    5 4    0
2531
 
 * +----+-----+-------------+---+------+------+------+------+
2532
 
 * | sf | opc | 1 0 0 1 0 0 | N | immr | imms |  Rn  |  Rd  |
2533
 
 * +----+-----+-------------+---+------+------+------+------+
2534
 
 */
2535
 
static void disas_logic_imm(DisasContext *s, uint32_t insn)
2536
 
{
2537
 
    unsigned int sf, opc, is_n, immr, imms, rn, rd;
2538
 
    TCGv_i64 tcg_rd, tcg_rn;
2539
 
    uint64_t wmask;
2540
 
    bool is_and = false;
2541
 
 
2542
 
    sf = extract32(insn, 31, 1);
2543
 
    opc = extract32(insn, 29, 2);
2544
 
    is_n = extract32(insn, 22, 1);
2545
 
    immr = extract32(insn, 16, 6);
2546
 
    imms = extract32(insn, 10, 6);
2547
 
    rn = extract32(insn, 5, 5);
2548
 
    rd = extract32(insn, 0, 5);
2549
 
 
2550
 
    if (!sf && is_n) {
2551
 
        unallocated_encoding(s);
2552
 
        return;
2553
 
    }
2554
 
 
2555
 
    if (opc == 0x3) { /* ANDS */
2556
 
        tcg_rd = cpu_reg(s, rd);
2557
 
    } else {
2558
 
        tcg_rd = cpu_reg_sp(s, rd);
2559
 
    }
2560
 
    tcg_rn = cpu_reg(s, rn);
2561
 
 
2562
 
    if (!logic_imm_decode_wmask(&wmask, is_n, imms, immr)) {
2563
 
        /* some immediate field values are reserved */
2564
 
        unallocated_encoding(s);
2565
 
        return;
2566
 
    }
2567
 
 
2568
 
    if (!sf) {
2569
 
        wmask &= 0xffffffff;
2570
 
    }
2571
 
 
2572
 
    switch (opc) {
2573
 
    case 0x3: /* ANDS */
2574
 
    case 0x0: /* AND */
2575
 
        tcg_gen_andi_i64(tcg_rd, tcg_rn, wmask);
2576
 
        is_and = true;
2577
 
        break;
2578
 
    case 0x1: /* ORR */
2579
 
        tcg_gen_ori_i64(tcg_rd, tcg_rn, wmask);
2580
 
        break;
2581
 
    case 0x2: /* EOR */
2582
 
        tcg_gen_xori_i64(tcg_rd, tcg_rn, wmask);
2583
 
        break;
2584
 
    default:
2585
 
        assert(FALSE); /* must handle all above */
2586
 
        break;
2587
 
    }
2588
 
 
2589
 
    if (!sf && !is_and) {
2590
 
        /* zero extend final result; we know we can skip this for AND
2591
 
         * since the immediate had the high 32 bits clear.
2592
 
         */
2593
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2594
 
    }
2595
 
 
2596
 
    if (opc == 3) { /* ANDS */
2597
 
        gen_logic_CC(sf, tcg_rd);
2598
 
    }
2599
 
}
2600
 
 
2601
 
/*
2602
 
 * C3.4.5 Move wide (immediate)
2603
 
 *
2604
 
 *  31 30 29 28         23 22 21 20             5 4    0
2605
 
 * +--+-----+-------------+-----+----------------+------+
2606
 
 * |sf| opc | 1 0 0 1 0 1 |  hw |  imm16         |  Rd  |
2607
 
 * +--+-----+-------------+-----+----------------+------+
2608
 
 *
2609
 
 * sf: 0 -> 32 bit, 1 -> 64 bit
2610
 
 * opc: 00 -> N, 10 -> Z, 11 -> K
2611
 
 * hw: shift/16 (0,16, and sf only 32, 48)
2612
 
 */
2613
 
static void disas_movw_imm(DisasContext *s, uint32_t insn)
2614
 
{
2615
 
    int rd = extract32(insn, 0, 5);
2616
 
    uint64_t imm = extract32(insn, 5, 16);
2617
 
    int sf = extract32(insn, 31, 1);
2618
 
    int opc = extract32(insn, 29, 2);
2619
 
    int pos = extract32(insn, 21, 2) << 4;
2620
 
    TCGv_i64 tcg_rd = cpu_reg(s, rd);
2621
 
    TCGv_i64 tcg_imm;
2622
 
 
2623
 
    if (!sf && (pos >= 32)) {
2624
 
        unallocated_encoding(s);
2625
 
        return;
2626
 
    }
2627
 
 
2628
 
    switch (opc) {
2629
 
    case 0: /* MOVN */
2630
 
    case 2: /* MOVZ */
2631
 
        imm <<= pos;
2632
 
        if (opc == 0) {
2633
 
            imm = ~imm;
2634
 
        }
2635
 
        if (!sf) {
2636
 
            imm &= 0xffffffffu;
2637
 
        }
2638
 
        tcg_gen_movi_i64(tcg_rd, imm);
2639
 
        break;
2640
 
    case 3: /* MOVK */
2641
 
        tcg_imm = tcg_const_i64(imm);
2642
 
        tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_imm, pos, 16);
2643
 
        tcg_temp_free_i64(tcg_imm);
2644
 
        if (!sf) {
2645
 
            tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2646
 
        }
2647
 
        break;
2648
 
    default:
2649
 
        unallocated_encoding(s);
2650
 
        break;
2651
 
    }
2652
 
}
2653
 
 
2654
 
/* C3.4.2 Bitfield
2655
 
 *   31  30 29 28         23 22  21  16 15  10 9    5 4    0
2656
 
 * +----+-----+-------------+---+------+------+------+------+
2657
 
 * | sf | opc | 1 0 0 1 1 0 | N | immr | imms |  Rn  |  Rd  |
2658
 
 * +----+-----+-------------+---+------+------+------+------+
2659
 
 */
2660
 
static void disas_bitfield(DisasContext *s, uint32_t insn)
2661
 
{
2662
 
    unsigned int sf, n, opc, ri, si, rn, rd, bitsize, pos, len;
2663
 
    TCGv_i64 tcg_rd, tcg_tmp;
2664
 
 
2665
 
    sf = extract32(insn, 31, 1);
2666
 
    opc = extract32(insn, 29, 2);
2667
 
    n = extract32(insn, 22, 1);
2668
 
    ri = extract32(insn, 16, 6);
2669
 
    si = extract32(insn, 10, 6);
2670
 
    rn = extract32(insn, 5, 5);
2671
 
    rd = extract32(insn, 0, 5);
2672
 
    bitsize = sf ? 64 : 32;
2673
 
 
2674
 
    if (sf != n || ri >= bitsize || si >= bitsize || opc > 2) {
2675
 
        unallocated_encoding(s);
2676
 
        return;
2677
 
    }
2678
 
 
2679
 
    tcg_rd = cpu_reg(s, rd);
2680
 
    tcg_tmp = read_cpu_reg(s, rn, sf);
2681
 
 
2682
 
    /* OPTME: probably worth recognizing common cases of ext{8,16,32}{u,s} */
2683
 
 
2684
 
    if (opc != 1) { /* SBFM or UBFM */
2685
 
        tcg_gen_movi_i64(tcg_rd, 0);
2686
 
    }
2687
 
 
2688
 
    /* do the bit move operation */
2689
 
    if (si >= ri) {
2690
 
        /* Wd<s-r:0> = Wn<s:r> */
2691
 
        tcg_gen_shri_i64(tcg_tmp, tcg_tmp, ri);
2692
 
        pos = 0;
2693
 
        len = (si - ri) + 1;
2694
 
    } else {
2695
 
        /* Wd<32+s-r,32-r> = Wn<s:0> */
2696
 
        pos = bitsize - ri;
2697
 
        len = si + 1;
2698
 
    }
2699
 
 
2700
 
    tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, pos, len);
2701
 
 
2702
 
    if (opc == 0) { /* SBFM - sign extend the destination field */
2703
 
        tcg_gen_shli_i64(tcg_rd, tcg_rd, 64 - (pos + len));
2704
 
        tcg_gen_sari_i64(tcg_rd, tcg_rd, 64 - (pos + len));
2705
 
    }
2706
 
 
2707
 
    if (!sf) { /* zero extend final result */
2708
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2709
 
    }
2710
 
}
2711
 
 
2712
 
/* C3.4.3 Extract
2713
 
 *   31  30  29 28         23 22   21  20  16 15    10 9    5 4    0
2714
 
 * +----+------+-------------+---+----+------+--------+------+------+
2715
 
 * | sf | op21 | 1 0 0 1 1 1 | N | o0 |  Rm  |  imms  |  Rn  |  Rd  |
2716
 
 * +----+------+-------------+---+----+------+--------+------+------+
2717
 
 */
2718
 
static void disas_extract(DisasContext *s, uint32_t insn)
2719
 
{
2720
 
    unsigned int sf, n, rm, imm, rn, rd, bitsize, op21, op0;
2721
 
 
2722
 
    sf = extract32(insn, 31, 1);
2723
 
    n = extract32(insn, 22, 1);
2724
 
    rm = extract32(insn, 16, 5);
2725
 
    imm = extract32(insn, 10, 6);
2726
 
    rn = extract32(insn, 5, 5);
2727
 
    rd = extract32(insn, 0, 5);
2728
 
    op21 = extract32(insn, 29, 2);
2729
 
    op0 = extract32(insn, 21, 1);
2730
 
    bitsize = sf ? 64 : 32;
2731
 
 
2732
 
    if (sf != n || op21 || op0 || imm >= bitsize) {
2733
 
        unallocated_encoding(s);
2734
 
    } else {
2735
 
        TCGv_i64 tcg_rd, tcg_rm, tcg_rn;
2736
 
 
2737
 
        tcg_rd = cpu_reg(s, rd);
2738
 
 
2739
 
        if (imm) {
2740
 
            /* OPTME: we can special case rm==rn as a rotate */
2741
 
            tcg_rm = read_cpu_reg(s, rm, sf);
2742
 
            tcg_rn = read_cpu_reg(s, rn, sf);
2743
 
            tcg_gen_shri_i64(tcg_rm, tcg_rm, imm);
2744
 
            tcg_gen_shli_i64(tcg_rn, tcg_rn, bitsize - imm);
2745
 
            tcg_gen_or_i64(tcg_rd, tcg_rm, tcg_rn);
2746
 
            if (!sf) {
2747
 
                tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2748
 
            }
2749
 
        } else {
2750
 
            /* tcg shl_i32/shl_i64 is undefined for 32/64 bit shifts,
2751
 
             * so an extract from bit 0 is a special case.
2752
 
             */
2753
 
            if (sf) {
2754
 
                tcg_gen_mov_i64(tcg_rd, cpu_reg(s, rm));
2755
 
            } else {
2756
 
                tcg_gen_ext32u_i64(tcg_rd, cpu_reg(s, rm));
2757
 
            }
2758
 
        }
2759
 
 
2760
 
    }
2761
 
}
2762
 
 
2763
 
/* C3.4 Data processing - immediate */
2764
 
static void disas_data_proc_imm(DisasContext *s, uint32_t insn)
2765
 
{
2766
 
    switch (extract32(insn, 23, 6)) {
2767
 
    case 0x20: case 0x21: /* PC-rel. addressing */
2768
 
        disas_pc_rel_adr(s, insn);
2769
 
        break;
2770
 
    case 0x22: case 0x23: /* Add/subtract (immediate) */
2771
 
        disas_add_sub_imm(s, insn);
2772
 
        break;
2773
 
    case 0x24: /* Logical (immediate) */
2774
 
        disas_logic_imm(s, insn);
2775
 
        break;
2776
 
    case 0x25: /* Move wide (immediate) */
2777
 
        disas_movw_imm(s, insn);
2778
 
        break;
2779
 
    case 0x26: /* Bitfield */
2780
 
        disas_bitfield(s, insn);
2781
 
        break;
2782
 
    case 0x27: /* Extract */
2783
 
        disas_extract(s, insn);
2784
 
        break;
2785
 
    default:
2786
 
        unallocated_encoding(s);
2787
 
        break;
2788
 
    }
2789
 
}
2790
 
 
2791
 
/* Shift a TCGv src by TCGv shift_amount, put result in dst.
2792
 
 * Note that it is the caller's responsibility to ensure that the
2793
 
 * shift amount is in range (ie 0..31 or 0..63) and provide the ARM
2794
 
 * mandated semantics for out of range shifts.
2795
 
 */
2796
 
static void shift_reg(TCGv_i64 dst, TCGv_i64 src, int sf,
2797
 
                      enum a64_shift_type shift_type, TCGv_i64 shift_amount)
2798
 
{
2799
 
    switch (shift_type) {
2800
 
    case A64_SHIFT_TYPE_LSL:
2801
 
        tcg_gen_shl_i64(dst, src, shift_amount);
2802
 
        break;
2803
 
    case A64_SHIFT_TYPE_LSR:
2804
 
        tcg_gen_shr_i64(dst, src, shift_amount);
2805
 
        break;
2806
 
    case A64_SHIFT_TYPE_ASR:
2807
 
        if (!sf) {
2808
 
            tcg_gen_ext32s_i64(dst, src);
2809
 
        }
2810
 
        tcg_gen_sar_i64(dst, sf ? src : dst, shift_amount);
2811
 
        break;
2812
 
    case A64_SHIFT_TYPE_ROR:
2813
 
        if (sf) {
2814
 
            tcg_gen_rotr_i64(dst, src, shift_amount);
2815
 
        } else {
2816
 
            TCGv_i32 t0, t1;
2817
 
            t0 = tcg_temp_new_i32();
2818
 
            t1 = tcg_temp_new_i32();
2819
 
            tcg_gen_trunc_i64_i32(t0, src);
2820
 
            tcg_gen_trunc_i64_i32(t1, shift_amount);
2821
 
            tcg_gen_rotr_i32(t0, t0, t1);
2822
 
            tcg_gen_extu_i32_i64(dst, t0);
2823
 
            tcg_temp_free_i32(t0);
2824
 
            tcg_temp_free_i32(t1);
2825
 
        }
2826
 
        break;
2827
 
    default:
2828
 
        assert(FALSE); /* all shift types should be handled */
2829
 
        break;
2830
 
    }
2831
 
 
2832
 
    if (!sf) { /* zero extend final result */
2833
 
        tcg_gen_ext32u_i64(dst, dst);
2834
 
    }
2835
 
}
2836
 
 
2837
 
/* Shift a TCGv src by immediate, put result in dst.
2838
 
 * The shift amount must be in range (this should always be true as the
2839
 
 * relevant instructions will UNDEF on bad shift immediates).
2840
 
 */
2841
 
static void shift_reg_imm(TCGv_i64 dst, TCGv_i64 src, int sf,
2842
 
                          enum a64_shift_type shift_type, unsigned int shift_i)
2843
 
{
2844
 
    assert(shift_i < (sf ? 64 : 32));
2845
 
 
2846
 
    if (shift_i == 0) {
2847
 
        tcg_gen_mov_i64(dst, src);
2848
 
    } else {
2849
 
        TCGv_i64 shift_const;
2850
 
 
2851
 
        shift_const = tcg_const_i64(shift_i);
2852
 
        shift_reg(dst, src, sf, shift_type, shift_const);
2853
 
        tcg_temp_free_i64(shift_const);
2854
 
    }
2855
 
}
2856
 
 
2857
 
/* C3.5.10 Logical (shifted register)
2858
 
 *   31  30 29 28       24 23   22 21  20  16 15    10 9    5 4    0
2859
 
 * +----+-----+-----------+-------+---+------+--------+------+------+
2860
 
 * | sf | opc | 0 1 0 1 0 | shift | N |  Rm  |  imm6  |  Rn  |  Rd  |
2861
 
 * +----+-----+-----------+-------+---+------+--------+------+------+
2862
 
 */
2863
 
static void disas_logic_reg(DisasContext *s, uint32_t insn)
2864
 
{
2865
 
    TCGv_i64 tcg_rd, tcg_rn, tcg_rm;
2866
 
    unsigned int sf, opc, shift_type, invert, rm, shift_amount, rn, rd;
2867
 
 
2868
 
    sf = extract32(insn, 31, 1);
2869
 
    opc = extract32(insn, 29, 2);
2870
 
    shift_type = extract32(insn, 22, 2);
2871
 
    invert = extract32(insn, 21, 1);
2872
 
    rm = extract32(insn, 16, 5);
2873
 
    shift_amount = extract32(insn, 10, 6);
2874
 
    rn = extract32(insn, 5, 5);
2875
 
    rd = extract32(insn, 0, 5);
2876
 
 
2877
 
    if (!sf && (shift_amount & (1 << 5))) {
2878
 
        unallocated_encoding(s);
2879
 
        return;
2880
 
    }
2881
 
 
2882
 
    tcg_rd = cpu_reg(s, rd);
2883
 
 
2884
 
    if (opc == 1 && shift_amount == 0 && shift_type == 0 && rn == 31) {
2885
 
        /* Unshifted ORR and ORN with WZR/XZR is the standard encoding for
2886
 
         * register-register MOV and MVN, so it is worth special casing.
2887
 
         */
2888
 
        tcg_rm = cpu_reg(s, rm);
2889
 
        if (invert) {
2890
 
            tcg_gen_not_i64(tcg_rd, tcg_rm);
2891
 
            if (!sf) {
2892
 
                tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2893
 
            }
2894
 
        } else {
2895
 
            if (sf) {
2896
 
                tcg_gen_mov_i64(tcg_rd, tcg_rm);
2897
 
            } else {
2898
 
                tcg_gen_ext32u_i64(tcg_rd, tcg_rm);
2899
 
            }
2900
 
        }
2901
 
        return;
2902
 
    }
2903
 
 
2904
 
    tcg_rm = read_cpu_reg(s, rm, sf);
2905
 
 
2906
 
    if (shift_amount) {
2907
 
        shift_reg_imm(tcg_rm, tcg_rm, sf, shift_type, shift_amount);
2908
 
    }
2909
 
 
2910
 
    tcg_rn = cpu_reg(s, rn);
2911
 
 
2912
 
    switch (opc | (invert << 2)) {
2913
 
    case 0: /* AND */
2914
 
    case 3: /* ANDS */
2915
 
        tcg_gen_and_i64(tcg_rd, tcg_rn, tcg_rm);
2916
 
        break;
2917
 
    case 1: /* ORR */
2918
 
        tcg_gen_or_i64(tcg_rd, tcg_rn, tcg_rm);
2919
 
        break;
2920
 
    case 2: /* EOR */
2921
 
        tcg_gen_xor_i64(tcg_rd, tcg_rn, tcg_rm);
2922
 
        break;
2923
 
    case 4: /* BIC */
2924
 
    case 7: /* BICS */
2925
 
        tcg_gen_andc_i64(tcg_rd, tcg_rn, tcg_rm);
2926
 
        break;
2927
 
    case 5: /* ORN */
2928
 
        tcg_gen_orc_i64(tcg_rd, tcg_rn, tcg_rm);
2929
 
        break;
2930
 
    case 6: /* EON */
2931
 
        tcg_gen_eqv_i64(tcg_rd, tcg_rn, tcg_rm);
2932
 
        break;
2933
 
    default:
2934
 
        assert(FALSE);
2935
 
        break;
2936
 
    }
2937
 
 
2938
 
    if (!sf) {
2939
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2940
 
    }
2941
 
 
2942
 
    if (opc == 3) {
2943
 
        gen_logic_CC(sf, tcg_rd);
2944
 
    }
2945
 
}
2946
 
 
2947
 
/*
2948
 
 * C3.5.1 Add/subtract (extended register)
2949
 
 *
2950
 
 *  31|30|29|28       24|23 22|21|20   16|15  13|12  10|9  5|4  0|
2951
 
 * +--+--+--+-----------+-----+--+-------+------+------+----+----+
2952
 
 * |sf|op| S| 0 1 0 1 1 | opt | 1|  Rm   |option| imm3 | Rn | Rd |
2953
 
 * +--+--+--+-----------+-----+--+-------+------+------+----+----+
2954
 
 *
2955
 
 *  sf: 0 -> 32bit, 1 -> 64bit
2956
 
 *  op: 0 -> add  , 1 -> sub
2957
 
 *   S: 1 -> set flags
2958
 
 * opt: 00
2959
 
 * option: extension type (see DecodeRegExtend)
2960
 
 * imm3: optional shift to Rm
2961
 
 *
2962
 
 * Rd = Rn + LSL(extend(Rm), amount)
2963
 
 */
2964
 
static void disas_add_sub_ext_reg(DisasContext *s, uint32_t insn)
2965
 
{
2966
 
    int rd = extract32(insn, 0, 5);
2967
 
    int rn = extract32(insn, 5, 5);
2968
 
    int imm3 = extract32(insn, 10, 3);
2969
 
    int option = extract32(insn, 13, 3);
2970
 
    int rm = extract32(insn, 16, 5);
2971
 
    bool setflags = extract32(insn, 29, 1);
2972
 
    bool sub_op = extract32(insn, 30, 1);
2973
 
    bool sf = extract32(insn, 31, 1);
2974
 
 
2975
 
    TCGv_i64 tcg_rm, tcg_rn; /* temps */
2976
 
    TCGv_i64 tcg_rd;
2977
 
    TCGv_i64 tcg_result;
2978
 
 
2979
 
    if (imm3 > 4) {
2980
 
        unallocated_encoding(s);
2981
 
        return;
2982
 
    }
2983
 
 
2984
 
    /* non-flag setting ops may use SP */
2985
 
    if (!setflags) {
2986
 
        tcg_rn = read_cpu_reg_sp(s, rn, sf);
2987
 
        tcg_rd = cpu_reg_sp(s, rd);
2988
 
    } else {
2989
 
        tcg_rn = read_cpu_reg(s, rn, sf);
2990
 
        tcg_rd = cpu_reg(s, rd);
2991
 
    }
2992
 
 
2993
 
    tcg_rm = read_cpu_reg(s, rm, sf);
2994
 
    ext_and_shift_reg(tcg_rm, tcg_rm, option, imm3);
2995
 
 
2996
 
    tcg_result = tcg_temp_new_i64();
2997
 
 
2998
 
    if (!setflags) {
2999
 
        if (sub_op) {
3000
 
            tcg_gen_sub_i64(tcg_result, tcg_rn, tcg_rm);
3001
 
        } else {
3002
 
            tcg_gen_add_i64(tcg_result, tcg_rn, tcg_rm);
3003
 
        }
3004
 
    } else {
3005
 
        if (sub_op) {
3006
 
            gen_sub_CC(sf, tcg_result, tcg_rn, tcg_rm);
3007
 
        } else {
3008
 
            gen_add_CC(sf, tcg_result, tcg_rn, tcg_rm);
3009
 
        }
3010
 
    }
3011
 
 
3012
 
    if (sf) {
3013
 
        tcg_gen_mov_i64(tcg_rd, tcg_result);
3014
 
    } else {
3015
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_result);
3016
 
    }
3017
 
 
3018
 
    tcg_temp_free_i64(tcg_result);
3019
 
}
3020
 
 
3021
 
/*
3022
 
 * C3.5.2 Add/subtract (shifted register)
3023
 
 *
3024
 
 *  31 30 29 28       24 23 22 21 20   16 15     10 9    5 4    0
3025
 
 * +--+--+--+-----------+-----+--+-------+---------+------+------+
3026
 
 * |sf|op| S| 0 1 0 1 1 |shift| 0|  Rm   |  imm6   |  Rn  |  Rd  |
3027
 
 * +--+--+--+-----------+-----+--+-------+---------+------+------+
3028
 
 *
3029
 
 *    sf: 0 -> 32bit, 1 -> 64bit
3030
 
 *    op: 0 -> add  , 1 -> sub
3031
 
 *     S: 1 -> set flags
3032
 
 * shift: 00 -> LSL, 01 -> LSR, 10 -> ASR, 11 -> RESERVED
3033
 
 *  imm6: Shift amount to apply to Rm before the add/sub
3034
 
 */
3035
 
static void disas_add_sub_reg(DisasContext *s, uint32_t insn)
3036
 
{
3037
 
    int rd = extract32(insn, 0, 5);
3038
 
    int rn = extract32(insn, 5, 5);
3039
 
    int imm6 = extract32(insn, 10, 6);
3040
 
    int rm = extract32(insn, 16, 5);
3041
 
    int shift_type = extract32(insn, 22, 2);
3042
 
    bool setflags = extract32(insn, 29, 1);
3043
 
    bool sub_op = extract32(insn, 30, 1);
3044
 
    bool sf = extract32(insn, 31, 1);
3045
 
 
3046
 
    TCGv_i64 tcg_rd = cpu_reg(s, rd);
3047
 
    TCGv_i64 tcg_rn, tcg_rm;
3048
 
    TCGv_i64 tcg_result;
3049
 
 
3050
 
    if ((shift_type == 3) || (!sf && (imm6 > 31))) {
3051
 
        unallocated_encoding(s);
3052
 
        return;
3053
 
    }
3054
 
 
3055
 
    tcg_rn = read_cpu_reg(s, rn, sf);
3056
 
    tcg_rm = read_cpu_reg(s, rm, sf);
3057
 
 
3058
 
    shift_reg_imm(tcg_rm, tcg_rm, sf, shift_type, imm6);
3059
 
 
3060
 
    tcg_result = tcg_temp_new_i64();
3061
 
 
3062
 
    if (!setflags) {
3063
 
        if (sub_op) {
3064
 
            tcg_gen_sub_i64(tcg_result, tcg_rn, tcg_rm);
3065
 
        } else {
3066
 
            tcg_gen_add_i64(tcg_result, tcg_rn, tcg_rm);
3067
 
        }
3068
 
    } else {
3069
 
        if (sub_op) {
3070
 
            gen_sub_CC(sf, tcg_result, tcg_rn, tcg_rm);
3071
 
        } else {
3072
 
            gen_add_CC(sf, tcg_result, tcg_rn, tcg_rm);
3073
 
        }
3074
 
    }
3075
 
 
3076
 
    if (sf) {
3077
 
        tcg_gen_mov_i64(tcg_rd, tcg_result);
3078
 
    } else {
3079
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_result);
3080
 
    }
3081
 
 
3082
 
    tcg_temp_free_i64(tcg_result);
3083
 
}
3084
 
 
3085
 
/* C3.5.9 Data-processing (3 source)
3086
 
 
3087
 
   31 30  29 28       24 23 21  20  16  15  14  10 9    5 4    0
3088
 
  +--+------+-----------+------+------+----+------+------+------+
3089
 
  |sf| op54 | 1 1 0 1 1 | op31 |  Rm  | o0 |  Ra  |  Rn  |  Rd  |
3090
 
  +--+------+-----------+------+------+----+------+------+------+
3091
 
 
3092
 
 */
3093
 
static void disas_data_proc_3src(DisasContext *s, uint32_t insn)
3094
 
{
3095
 
    int rd = extract32(insn, 0, 5);
3096
 
    int rn = extract32(insn, 5, 5);
3097
 
    int ra = extract32(insn, 10, 5);
3098
 
    int rm = extract32(insn, 16, 5);
3099
 
    int op_id = (extract32(insn, 29, 3) << 4) |
3100
 
        (extract32(insn, 21, 3) << 1) |
3101
 
        extract32(insn, 15, 1);
3102
 
    bool sf = extract32(insn, 31, 1);
3103
 
    bool is_sub = extract32(op_id, 0, 1);
3104
 
    bool is_high = extract32(op_id, 2, 1);
3105
 
    bool is_signed = false;
3106
 
    TCGv_i64 tcg_op1;
3107
 
    TCGv_i64 tcg_op2;
3108
 
    TCGv_i64 tcg_tmp;
3109
 
 
3110
 
    /* Note that op_id is sf:op54:op31:o0 so it includes the 32/64 size flag */
3111
 
    switch (op_id) {
3112
 
    case 0x42: /* SMADDL */
3113
 
    case 0x43: /* SMSUBL */
3114
 
    case 0x44: /* SMULH */
3115
 
        is_signed = true;
3116
 
        break;
3117
 
    case 0x0: /* MADD (32bit) */
3118
 
    case 0x1: /* MSUB (32bit) */
3119
 
    case 0x40: /* MADD (64bit) */
3120
 
    case 0x41: /* MSUB (64bit) */
3121
 
    case 0x4a: /* UMADDL */
3122
 
    case 0x4b: /* UMSUBL */
3123
 
    case 0x4c: /* UMULH */
3124
 
        break;
3125
 
    default:
3126
 
        unallocated_encoding(s);
3127
 
        return;
3128
 
    }
3129
 
 
3130
 
    if (is_high) {
3131
 
        TCGv_i64 low_bits = tcg_temp_new_i64(); /* low bits discarded */
3132
 
        TCGv_i64 tcg_rd = cpu_reg(s, rd);
3133
 
        TCGv_i64 tcg_rn = cpu_reg(s, rn);
3134
 
        TCGv_i64 tcg_rm = cpu_reg(s, rm);
3135
 
 
3136
 
        if (is_signed) {
3137
 
            tcg_gen_muls2_i64(low_bits, tcg_rd, tcg_rn, tcg_rm);
3138
 
        } else {
3139
 
            tcg_gen_mulu2_i64(low_bits, tcg_rd, tcg_rn, tcg_rm);
3140
 
        }
3141
 
 
3142
 
        tcg_temp_free_i64(low_bits);
3143
 
        return;
3144
 
    }
3145
 
 
3146
 
    tcg_op1 = tcg_temp_new_i64();
3147
 
    tcg_op2 = tcg_temp_new_i64();
3148
 
    tcg_tmp = tcg_temp_new_i64();
3149
 
 
3150
 
    if (op_id < 0x42) {
3151
 
        tcg_gen_mov_i64(tcg_op1, cpu_reg(s, rn));
3152
 
        tcg_gen_mov_i64(tcg_op2, cpu_reg(s, rm));
3153
 
    } else {
3154
 
        if (is_signed) {
3155
 
            tcg_gen_ext32s_i64(tcg_op1, cpu_reg(s, rn));
3156
 
            tcg_gen_ext32s_i64(tcg_op2, cpu_reg(s, rm));
3157
 
        } else {
3158
 
            tcg_gen_ext32u_i64(tcg_op1, cpu_reg(s, rn));
3159
 
            tcg_gen_ext32u_i64(tcg_op2, cpu_reg(s, rm));
3160
 
        }
3161
 
    }
3162
 
 
3163
 
    if (ra == 31 && !is_sub) {
3164
 
        /* Special-case MADD with rA == XZR; it is the standard MUL alias */
3165
 
        tcg_gen_mul_i64(cpu_reg(s, rd), tcg_op1, tcg_op2);
3166
 
    } else {
3167
 
        tcg_gen_mul_i64(tcg_tmp, tcg_op1, tcg_op2);
3168
 
        if (is_sub) {
3169
 
            tcg_gen_sub_i64(cpu_reg(s, rd), cpu_reg(s, ra), tcg_tmp);
3170
 
        } else {
3171
 
            tcg_gen_add_i64(cpu_reg(s, rd), cpu_reg(s, ra), tcg_tmp);
3172
 
        }
3173
 
    }
3174
 
 
3175
 
    if (!sf) {
3176
 
        tcg_gen_ext32u_i64(cpu_reg(s, rd), cpu_reg(s, rd));
3177
 
    }
3178
 
 
3179
 
    tcg_temp_free_i64(tcg_op1);
3180
 
    tcg_temp_free_i64(tcg_op2);
3181
 
    tcg_temp_free_i64(tcg_tmp);
3182
 
}
3183
 
 
3184
 
/* C3.5.3 - Add/subtract (with carry)
3185
 
 *  31 30 29 28 27 26 25 24 23 22 21  20  16  15   10  9    5 4   0
3186
 
 * +--+--+--+------------------------+------+---------+------+-----+
3187
 
 * |sf|op| S| 1  1  0  1  0  0  0  0 |  rm  | opcode2 |  Rn  |  Rd |
3188
 
 * +--+--+--+------------------------+------+---------+------+-----+
3189
 
 *                                            [000000]
3190
 
 */
3191
 
 
3192
 
static void disas_adc_sbc(DisasContext *s, uint32_t insn)
3193
 
{
3194
 
    unsigned int sf, op, setflags, rm, rn, rd;
3195
 
    TCGv_i64 tcg_y, tcg_rn, tcg_rd;
3196
 
 
3197
 
    if (extract32(insn, 10, 6) != 0) {
3198
 
        unallocated_encoding(s);
3199
 
        return;
3200
 
    }
3201
 
 
3202
 
    sf = extract32(insn, 31, 1);
3203
 
    op = extract32(insn, 30, 1);
3204
 
    setflags = extract32(insn, 29, 1);
3205
 
    rm = extract32(insn, 16, 5);
3206
 
    rn = extract32(insn, 5, 5);
3207
 
    rd = extract32(insn, 0, 5);
3208
 
 
3209
 
    tcg_rd = cpu_reg(s, rd);
3210
 
    tcg_rn = cpu_reg(s, rn);
3211
 
 
3212
 
    if (op) {
3213
 
        tcg_y = new_tmp_a64(s);
3214
 
        tcg_gen_not_i64(tcg_y, cpu_reg(s, rm));
3215
 
    } else {
3216
 
        tcg_y = cpu_reg(s, rm);
3217
 
    }
3218
 
 
3219
 
    if (setflags) {
3220
 
        gen_adc_CC(sf, tcg_rd, tcg_rn, tcg_y);
3221
 
    } else {
3222
 
        gen_adc(sf, tcg_rd, tcg_rn, tcg_y);
3223
 
    }
3224
 
}
3225
 
 
3226
 
/* C3.5.4 - C3.5.5 Conditional compare (immediate / register)
3227
 
 *  31 30 29 28 27 26 25 24 23 22 21  20    16 15  12  11  10  9   5  4 3   0
3228
 
 * +--+--+--+------------------------+--------+------+----+--+------+--+-----+
3229
 
 * |sf|op| S| 1  1  0  1  0  0  1  0 |imm5/rm | cond |i/r |o2|  Rn  |o3|nzcv |
3230
 
 * +--+--+--+------------------------+--------+------+----+--+------+--+-----+
3231
 
 *        [1]                             y                [0]       [0]
3232
 
 */
3233
 
static void disas_cc(DisasContext *s, uint32_t insn)
3234
 
{
3235
 
    unsigned int sf, op, y, cond, rn, nzcv, is_imm;
3236
 
    int label_continue = -1;
3237
 
    TCGv_i64 tcg_tmp, tcg_y, tcg_rn;
3238
 
 
3239
 
    if (!extract32(insn, 29, 1)) {
3240
 
        unallocated_encoding(s);
3241
 
        return;
3242
 
    }
3243
 
    if (insn & (1 << 10 | 1 << 4)) {
3244
 
        unallocated_encoding(s);
3245
 
        return;
3246
 
    }
3247
 
    sf = extract32(insn, 31, 1);
3248
 
    op = extract32(insn, 30, 1);
3249
 
    is_imm = extract32(insn, 11, 1);
3250
 
    y = extract32(insn, 16, 5); /* y = rm (reg) or imm5 (imm) */
3251
 
    cond = extract32(insn, 12, 4);
3252
 
    rn = extract32(insn, 5, 5);
3253
 
    nzcv = extract32(insn, 0, 4);
3254
 
 
3255
 
    if (cond < 0x0e) { /* not always */
3256
 
        int label_match = gen_new_label();
3257
 
        label_continue = gen_new_label();
3258
 
        arm_gen_test_cc(cond, label_match);
3259
 
        /* nomatch: */
3260
 
        tcg_tmp = tcg_temp_new_i64();
3261
 
        tcg_gen_movi_i64(tcg_tmp, nzcv << 28);
3262
 
        gen_set_nzcv(tcg_tmp);
3263
 
        tcg_temp_free_i64(tcg_tmp);
3264
 
        tcg_gen_br(label_continue);
3265
 
        gen_set_label(label_match);
3266
 
    }
3267
 
    /* match, or condition is always */
3268
 
    if (is_imm) {
3269
 
        tcg_y = new_tmp_a64(s);
3270
 
        tcg_gen_movi_i64(tcg_y, y);
3271
 
    } else {
3272
 
        tcg_y = cpu_reg(s, y);
3273
 
    }
3274
 
    tcg_rn = cpu_reg(s, rn);
3275
 
 
3276
 
    tcg_tmp = tcg_temp_new_i64();
3277
 
    if (op) {
3278
 
        gen_sub_CC(sf, tcg_tmp, tcg_rn, tcg_y);
3279
 
    } else {
3280
 
        gen_add_CC(sf, tcg_tmp, tcg_rn, tcg_y);
3281
 
    }
3282
 
    tcg_temp_free_i64(tcg_tmp);
3283
 
 
3284
 
    if (cond < 0x0e) { /* continue */
3285
 
        gen_set_label(label_continue);
3286
 
    }
3287
 
}
3288
 
 
3289
 
/* C3.5.6 Conditional select
3290
 
 *   31   30  29  28             21 20  16 15  12 11 10 9    5 4    0
3291
 
 * +----+----+---+-----------------+------+------+-----+------+------+
3292
 
 * | sf | op | S | 1 1 0 1 0 1 0 0 |  Rm  | cond | op2 |  Rn  |  Rd  |
3293
 
 * +----+----+---+-----------------+------+------+-----+------+------+
3294
 
 */
3295
 
static void disas_cond_select(DisasContext *s, uint32_t insn)
3296
 
{
3297
 
    unsigned int sf, else_inv, rm, cond, else_inc, rn, rd;
3298
 
    TCGv_i64 tcg_rd, tcg_src;
3299
 
 
3300
 
    if (extract32(insn, 29, 1) || extract32(insn, 11, 1)) {
3301
 
        /* S == 1 or op2<1> == 1 */
3302
 
        unallocated_encoding(s);
3303
 
        return;
3304
 
    }
3305
 
    sf = extract32(insn, 31, 1);
3306
 
    else_inv = extract32(insn, 30, 1);
3307
 
    rm = extract32(insn, 16, 5);
3308
 
    cond = extract32(insn, 12, 4);
3309
 
    else_inc = extract32(insn, 10, 1);
3310
 
    rn = extract32(insn, 5, 5);
3311
 
    rd = extract32(insn, 0, 5);
3312
 
 
3313
 
    if (rd == 31) {
3314
 
        /* silly no-op write; until we use movcond we must special-case
3315
 
         * this to avoid a dead temporary across basic blocks.
3316
 
         */
3317
 
        return;
3318
 
    }
3319
 
 
3320
 
    tcg_rd = cpu_reg(s, rd);
3321
 
 
3322
 
    if (cond >= 0x0e) { /* condition "always" */
3323
 
        tcg_src = read_cpu_reg(s, rn, sf);
3324
 
        tcg_gen_mov_i64(tcg_rd, tcg_src);
3325
 
    } else {
3326
 
        /* OPTME: we could use movcond here, at the cost of duplicating
3327
 
         * a lot of the arm_gen_test_cc() logic.
3328
 
         */
3329
 
        int label_match = gen_new_label();
3330
 
        int label_continue = gen_new_label();
3331
 
 
3332
 
        arm_gen_test_cc(cond, label_match);
3333
 
        /* nomatch: */
3334
 
        tcg_src = cpu_reg(s, rm);
3335
 
 
3336
 
        if (else_inv && else_inc) {
3337
 
            tcg_gen_neg_i64(tcg_rd, tcg_src);
3338
 
        } else if (else_inv) {
3339
 
            tcg_gen_not_i64(tcg_rd, tcg_src);
3340
 
        } else if (else_inc) {
3341
 
            tcg_gen_addi_i64(tcg_rd, tcg_src, 1);
3342
 
        } else {
3343
 
            tcg_gen_mov_i64(tcg_rd, tcg_src);
3344
 
        }
3345
 
        if (!sf) {
3346
 
            tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
3347
 
        }
3348
 
        tcg_gen_br(label_continue);
3349
 
        /* match: */
3350
 
        gen_set_label(label_match);
3351
 
        tcg_src = read_cpu_reg(s, rn, sf);
3352
 
        tcg_gen_mov_i64(tcg_rd, tcg_src);
3353
 
        /* continue: */
3354
 
        gen_set_label(label_continue);
3355
 
    }
3356
 
}
3357
 
 
3358
 
static void handle_clz(DisasContext *s, unsigned int sf,
3359
 
                       unsigned int rn, unsigned int rd)
3360
 
{
3361
 
    TCGv_i64 tcg_rd, tcg_rn;
3362
 
    tcg_rd = cpu_reg(s, rd);
3363
 
    tcg_rn = cpu_reg(s, rn);
3364
 
 
3365
 
    if (sf) {
3366
 
        gen_helper_clz64(tcg_rd, tcg_rn);
3367
 
    } else {
3368
 
        TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
3369
 
        tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
3370
 
        gen_helper_clz(tcg_tmp32, tcg_tmp32);
3371
 
        tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
3372
 
        tcg_temp_free_i32(tcg_tmp32);
3373
 
    }
3374
 
}
3375
 
 
3376
 
static void handle_cls(DisasContext *s, unsigned int sf,
3377
 
                       unsigned int rn, unsigned int rd)
3378
 
{
3379
 
    TCGv_i64 tcg_rd, tcg_rn;
3380
 
    tcg_rd = cpu_reg(s, rd);
3381
 
    tcg_rn = cpu_reg(s, rn);
3382
 
 
3383
 
    if (sf) {
3384
 
        gen_helper_cls64(tcg_rd, tcg_rn);
3385
 
    } else {
3386
 
        TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
3387
 
        tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
3388
 
        gen_helper_cls32(tcg_tmp32, tcg_tmp32);
3389
 
        tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
3390
 
        tcg_temp_free_i32(tcg_tmp32);
3391
 
    }
3392
 
}
3393
 
 
3394
 
static void handle_rbit(DisasContext *s, unsigned int sf,
3395
 
                        unsigned int rn, unsigned int rd)
3396
 
{
3397
 
    TCGv_i64 tcg_rd, tcg_rn;
3398
 
    tcg_rd = cpu_reg(s, rd);
3399
 
    tcg_rn = cpu_reg(s, rn);
3400
 
 
3401
 
    if (sf) {
3402
 
        gen_helper_rbit64(tcg_rd, tcg_rn);
3403
 
    } else {
3404
 
        TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
3405
 
        tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
3406
 
        gen_helper_rbit(tcg_tmp32, tcg_tmp32);
3407
 
        tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
3408
 
        tcg_temp_free_i32(tcg_tmp32);
3409
 
    }
3410
 
}
3411
 
 
3412
 
/* C5.6.149 REV with sf==1, opcode==3 ("REV64") */
3413
 
static void handle_rev64(DisasContext *s, unsigned int sf,
3414
 
                         unsigned int rn, unsigned int rd)
3415
 
{
3416
 
    if (!sf) {
3417
 
        unallocated_encoding(s);
3418
 
        return;
3419
 
    }
3420
 
    tcg_gen_bswap64_i64(cpu_reg(s, rd), cpu_reg(s, rn));
3421
 
}
3422
 
 
3423
 
/* C5.6.149 REV with sf==0, opcode==2
3424
 
 * C5.6.151 REV32 (sf==1, opcode==2)
3425
 
 */
3426
 
static void handle_rev32(DisasContext *s, unsigned int sf,
3427
 
                         unsigned int rn, unsigned int rd)
3428
 
{
3429
 
    TCGv_i64 tcg_rd = cpu_reg(s, rd);
3430
 
 
3431
 
    if (sf) {
3432
 
        TCGv_i64 tcg_tmp = tcg_temp_new_i64();
3433
 
        TCGv_i64 tcg_rn = read_cpu_reg(s, rn, sf);
3434
 
 
3435
 
        /* bswap32_i64 requires zero high word */
3436
 
        tcg_gen_ext32u_i64(tcg_tmp, tcg_rn);
3437
 
        tcg_gen_bswap32_i64(tcg_rd, tcg_tmp);
3438
 
        tcg_gen_shri_i64(tcg_tmp, tcg_rn, 32);
3439
 
        tcg_gen_bswap32_i64(tcg_tmp, tcg_tmp);
3440
 
        tcg_gen_concat32_i64(tcg_rd, tcg_rd, tcg_tmp);
3441
 
 
3442
 
        tcg_temp_free_i64(tcg_tmp);
3443
 
    } else {
3444
 
        tcg_gen_ext32u_i64(tcg_rd, cpu_reg(s, rn));
3445
 
        tcg_gen_bswap32_i64(tcg_rd, tcg_rd);
3446
 
    }
3447
 
}
3448
 
 
3449
 
/* C5.6.150 REV16 (opcode==1) */
3450
 
static void handle_rev16(DisasContext *s, unsigned int sf,
3451
 
                         unsigned int rn, unsigned int rd)
3452
 
{
3453
 
    TCGv_i64 tcg_rd = cpu_reg(s, rd);
3454
 
    TCGv_i64 tcg_tmp = tcg_temp_new_i64();
3455
 
    TCGv_i64 tcg_rn = read_cpu_reg(s, rn, sf);
3456
 
 
3457
 
    tcg_gen_andi_i64(tcg_tmp, tcg_rn, 0xffff);
3458
 
    tcg_gen_bswap16_i64(tcg_rd, tcg_tmp);
3459
 
 
3460
 
    tcg_gen_shri_i64(tcg_tmp, tcg_rn, 16);
3461
 
    tcg_gen_andi_i64(tcg_tmp, tcg_tmp, 0xffff);
3462
 
    tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
3463
 
    tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 16, 16);
3464
 
 
3465
 
    if (sf) {
3466
 
        tcg_gen_shri_i64(tcg_tmp, tcg_rn, 32);
3467
 
        tcg_gen_andi_i64(tcg_tmp, tcg_tmp, 0xffff);
3468
 
        tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
3469
 
        tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 32, 16);
3470
 
 
3471
 
        tcg_gen_shri_i64(tcg_tmp, tcg_rn, 48);
3472
 
        tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
3473
 
        tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 48, 16);
3474
 
    }
3475
 
 
3476
 
    tcg_temp_free_i64(tcg_tmp);
3477
 
}
3478
 
 
3479
 
/* C3.5.7 Data-processing (1 source)
3480
 
 *   31  30  29  28             21 20     16 15    10 9    5 4    0
3481
 
 * +----+---+---+-----------------+---------+--------+------+------+
3482
 
 * | sf | 1 | S | 1 1 0 1 0 1 1 0 | opcode2 | opcode |  Rn  |  Rd  |
3483
 
 * +----+---+---+-----------------+---------+--------+------+------+
3484
 
 */
3485
 
static void disas_data_proc_1src(DisasContext *s, uint32_t insn)
3486
 
{
3487
 
    unsigned int sf, opcode, rn, rd;
3488
 
 
3489
 
    if (extract32(insn, 29, 1) || extract32(insn, 16, 5)) {
3490
 
        unallocated_encoding(s);
3491
 
        return;
3492
 
    }
3493
 
 
3494
 
    sf = extract32(insn, 31, 1);
3495
 
    opcode = extract32(insn, 10, 6);
3496
 
    rn = extract32(insn, 5, 5);
3497
 
    rd = extract32(insn, 0, 5);
3498
 
 
3499
 
    switch (opcode) {
3500
 
    case 0: /* RBIT */
3501
 
        handle_rbit(s, sf, rn, rd);
3502
 
        break;
3503
 
    case 1: /* REV16 */
3504
 
        handle_rev16(s, sf, rn, rd);
3505
 
        break;
3506
 
    case 2: /* REV32 */
3507
 
        handle_rev32(s, sf, rn, rd);
3508
 
        break;
3509
 
    case 3: /* REV64 */
3510
 
        handle_rev64(s, sf, rn, rd);
3511
 
        break;
3512
 
    case 4: /* CLZ */
3513
 
        handle_clz(s, sf, rn, rd);
3514
 
        break;
3515
 
    case 5: /* CLS */
3516
 
        handle_cls(s, sf, rn, rd);
3517
 
        break;
3518
 
    }
3519
 
}
3520
 
 
3521
 
static void handle_div(DisasContext *s, bool is_signed, unsigned int sf,
3522
 
                       unsigned int rm, unsigned int rn, unsigned int rd)
3523
 
{
3524
 
    TCGv_i64 tcg_n, tcg_m, tcg_rd;
3525
 
    tcg_rd = cpu_reg(s, rd);
3526
 
 
3527
 
    if (!sf && is_signed) {
3528
 
        tcg_n = new_tmp_a64(s);
3529
 
        tcg_m = new_tmp_a64(s);
3530
 
        tcg_gen_ext32s_i64(tcg_n, cpu_reg(s, rn));
3531
 
        tcg_gen_ext32s_i64(tcg_m, cpu_reg(s, rm));
3532
 
    } else {
3533
 
        tcg_n = read_cpu_reg(s, rn, sf);
3534
 
        tcg_m = read_cpu_reg(s, rm, sf);
3535
 
    }
3536
 
 
3537
 
    if (is_signed) {
3538
 
        gen_helper_sdiv64(tcg_rd, tcg_n, tcg_m);
3539
 
    } else {
3540
 
        gen_helper_udiv64(tcg_rd, tcg_n, tcg_m);
3541
 
    }
3542
 
 
3543
 
    if (!sf) { /* zero extend final result */
3544
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
3545
 
    }
3546
 
}
3547
 
 
3548
 
/* C5.6.115 LSLV, C5.6.118 LSRV, C5.6.17 ASRV, C5.6.154 RORV */
3549
 
static void handle_shift_reg(DisasContext *s,
3550
 
                             enum a64_shift_type shift_type, unsigned int sf,
3551
 
                             unsigned int rm, unsigned int rn, unsigned int rd)
3552
 
{
3553
 
    TCGv_i64 tcg_shift = tcg_temp_new_i64();
3554
 
    TCGv_i64 tcg_rd = cpu_reg(s, rd);
3555
 
    TCGv_i64 tcg_rn = read_cpu_reg(s, rn, sf);
3556
 
 
3557
 
    tcg_gen_andi_i64(tcg_shift, cpu_reg(s, rm), sf ? 63 : 31);
3558
 
    shift_reg(tcg_rd, tcg_rn, sf, shift_type, tcg_shift);
3559
 
    tcg_temp_free_i64(tcg_shift);
3560
 
}
3561
 
 
3562
 
/* C3.5.8 Data-processing (2 source)
3563
 
 *   31   30  29 28             21 20  16 15    10 9    5 4    0
3564
 
 * +----+---+---+-----------------+------+--------+------+------+
3565
 
 * | sf | 0 | S | 1 1 0 1 0 1 1 0 |  Rm  | opcode |  Rn  |  Rd  |
3566
 
 * +----+---+---+-----------------+------+--------+------+------+
3567
 
 */
3568
 
static void disas_data_proc_2src(DisasContext *s, uint32_t insn)
3569
 
{
3570
 
    unsigned int sf, rm, opcode, rn, rd;
3571
 
    sf = extract32(insn, 31, 1);
3572
 
    rm = extract32(insn, 16, 5);
3573
 
    opcode = extract32(insn, 10, 6);
3574
 
    rn = extract32(insn, 5, 5);
3575
 
    rd = extract32(insn, 0, 5);
3576
 
 
3577
 
    if (extract32(insn, 29, 1)) {
3578
 
        unallocated_encoding(s);
3579
 
        return;
3580
 
    }
3581
 
 
3582
 
    switch (opcode) {
3583
 
    case 2: /* UDIV */
3584
 
        handle_div(s, false, sf, rm, rn, rd);
3585
 
        break;
3586
 
    case 3: /* SDIV */
3587
 
        handle_div(s, true, sf, rm, rn, rd);
3588
 
        break;
3589
 
    case 8: /* LSLV */
3590
 
        handle_shift_reg(s, A64_SHIFT_TYPE_LSL, sf, rm, rn, rd);
3591
 
        break;
3592
 
    case 9: /* LSRV */
3593
 
        handle_shift_reg(s, A64_SHIFT_TYPE_LSR, sf, rm, rn, rd);
3594
 
        break;
3595
 
    case 10: /* ASRV */
3596
 
        handle_shift_reg(s, A64_SHIFT_TYPE_ASR, sf, rm, rn, rd);
3597
 
        break;
3598
 
    case 11: /* RORV */
3599
 
        handle_shift_reg(s, A64_SHIFT_TYPE_ROR, sf, rm, rn, rd);
3600
 
        break;
3601
 
    case 16:
3602
 
    case 17:
3603
 
    case 18:
3604
 
    case 19:
3605
 
    case 20:
3606
 
    case 21:
3607
 
    case 22:
3608
 
    case 23: /* CRC32 */
3609
 
        unsupported_encoding(s, insn);
3610
 
        break;
3611
 
    default:
3612
 
        unallocated_encoding(s);
3613
 
        break;
3614
 
    }
3615
 
}
3616
 
 
3617
 
/* C3.5 Data processing - register */
3618
 
static void disas_data_proc_reg(DisasContext *s, uint32_t insn)
3619
 
{
3620
 
    switch (extract32(insn, 24, 5)) {
3621
 
    case 0x0a: /* Logical (shifted register) */
3622
 
        disas_logic_reg(s, insn);
3623
 
        break;
3624
 
    case 0x0b: /* Add/subtract */
3625
 
        if (insn & (1 << 21)) { /* (extended register) */
3626
 
            disas_add_sub_ext_reg(s, insn);
3627
 
        } else {
3628
 
            disas_add_sub_reg(s, insn);
3629
 
        }
3630
 
        break;
3631
 
    case 0x1b: /* Data-processing (3 source) */
3632
 
        disas_data_proc_3src(s, insn);
3633
 
        break;
3634
 
    case 0x1a:
3635
 
        switch (extract32(insn, 21, 3)) {
3636
 
        case 0x0: /* Add/subtract (with carry) */
3637
 
            disas_adc_sbc(s, insn);
3638
 
            break;
3639
 
        case 0x2: /* Conditional compare */
3640
 
            disas_cc(s, insn); /* both imm and reg forms */
3641
 
            break;
3642
 
        case 0x4: /* Conditional select */
3643
 
            disas_cond_select(s, insn);
3644
 
            break;
3645
 
        case 0x6: /* Data-processing */
3646
 
            if (insn & (1 << 30)) { /* (1 source) */
3647
 
                disas_data_proc_1src(s, insn);
3648
 
            } else {            /* (2 source) */
3649
 
                disas_data_proc_2src(s, insn);
3650
 
            }
3651
 
            break;
3652
 
        default:
3653
 
            unallocated_encoding(s);
3654
 
            break;
3655
 
        }
3656
 
        break;
3657
 
    default:
3658
 
        unallocated_encoding(s);
3659
 
        break;
3660
 
    }
3661
 
}
3662
 
 
3663
 
static void handle_fp_compare(DisasContext *s, bool is_double,
3664
 
                              unsigned int rn, unsigned int rm,
3665
 
                              bool cmp_with_zero, bool signal_all_nans)
3666
 
{
3667
 
    TCGv_i64 tcg_flags = tcg_temp_new_i64();
3668
 
    TCGv_ptr fpst = get_fpstatus_ptr();
3669
 
 
3670
 
    if (is_double) {
3671
 
        TCGv_i64 tcg_vn, tcg_vm;
3672
 
 
3673
 
        tcg_vn = read_fp_dreg(s, rn);
3674
 
        if (cmp_with_zero) {
3675
 
            tcg_vm = tcg_const_i64(0);
3676
 
        } else {
3677
 
            tcg_vm = read_fp_dreg(s, rm);
3678
 
        }
3679
 
        if (signal_all_nans) {
3680
 
            gen_helper_vfp_cmped_a64(tcg_flags, tcg_vn, tcg_vm, fpst);
3681
 
        } else {
3682
 
            gen_helper_vfp_cmpd_a64(tcg_flags, tcg_vn, tcg_vm, fpst);
3683
 
        }
3684
 
        tcg_temp_free_i64(tcg_vn);
3685
 
        tcg_temp_free_i64(tcg_vm);
3686
 
    } else {
3687
 
        TCGv_i32 tcg_vn, tcg_vm;
3688
 
 
3689
 
        tcg_vn = read_fp_sreg(s, rn);
3690
 
        if (cmp_with_zero) {
3691
 
            tcg_vm = tcg_const_i32(0);
3692
 
        } else {
3693
 
            tcg_vm = read_fp_sreg(s, rm);
3694
 
        }
3695
 
        if (signal_all_nans) {
3696
 
            gen_helper_vfp_cmpes_a64(tcg_flags, tcg_vn, tcg_vm, fpst);
3697
 
        } else {
3698
 
            gen_helper_vfp_cmps_a64(tcg_flags, tcg_vn, tcg_vm, fpst);
3699
 
        }
3700
 
        tcg_temp_free_i32(tcg_vn);
3701
 
        tcg_temp_free_i32(tcg_vm);
3702
 
    }
3703
 
 
3704
 
    tcg_temp_free_ptr(fpst);
3705
 
 
3706
 
    gen_set_nzcv(tcg_flags);
3707
 
 
3708
 
    tcg_temp_free_i64(tcg_flags);
3709
 
}
3710
 
 
3711
 
/* C3.6.22 Floating point compare
3712
 
 *   31  30  29 28       24 23  22  21 20  16 15 14 13  10    9    5 4     0
3713
 
 * +---+---+---+-----------+------+---+------+-----+---------+------+-------+
3714
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 |  Rm  | op  | 1 0 0 0 |  Rn  |  op2  |
3715
 
 * +---+---+---+-----------+------+---+------+-----+---------+------+-------+
3716
 
 */
3717
 
static void disas_fp_compare(DisasContext *s, uint32_t insn)
3718
 
{
3719
 
    unsigned int mos, type, rm, op, rn, opc, op2r;
3720
 
 
3721
 
    mos = extract32(insn, 29, 3);
3722
 
    type = extract32(insn, 22, 2); /* 0 = single, 1 = double */
3723
 
    rm = extract32(insn, 16, 5);
3724
 
    op = extract32(insn, 14, 2);
3725
 
    rn = extract32(insn, 5, 5);
3726
 
    opc = extract32(insn, 3, 2);
3727
 
    op2r = extract32(insn, 0, 3);
3728
 
 
3729
 
    if (mos || op || op2r || type > 1) {
3730
 
        unallocated_encoding(s);
3731
 
        return;
3732
 
    }
3733
 
 
3734
 
    handle_fp_compare(s, type, rn, rm, opc & 1, opc & 2);
3735
 
}
3736
 
 
3737
 
/* C3.6.23 Floating point conditional compare
3738
 
 *   31  30  29 28       24 23  22  21 20  16 15  12 11 10 9    5  4   3    0
3739
 
 * +---+---+---+-----------+------+---+------+------+-----+------+----+------+
3740
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 |  Rm  | cond | 0 1 |  Rn  | op | nzcv |
3741
 
 * +---+---+---+-----------+------+---+------+------+-----+------+----+------+
3742
 
 */
3743
 
static void disas_fp_ccomp(DisasContext *s, uint32_t insn)
3744
 
{
3745
 
    unsigned int mos, type, rm, cond, rn, op, nzcv;
3746
 
    TCGv_i64 tcg_flags;
3747
 
    int label_continue = -1;
3748
 
 
3749
 
    mos = extract32(insn, 29, 3);
3750
 
    type = extract32(insn, 22, 2); /* 0 = single, 1 = double */
3751
 
    rm = extract32(insn, 16, 5);
3752
 
    cond = extract32(insn, 12, 4);
3753
 
    rn = extract32(insn, 5, 5);
3754
 
    op = extract32(insn, 4, 1);
3755
 
    nzcv = extract32(insn, 0, 4);
3756
 
 
3757
 
    if (mos || type > 1) {
3758
 
        unallocated_encoding(s);
3759
 
        return;
3760
 
    }
3761
 
 
3762
 
    if (cond < 0x0e) { /* not always */
3763
 
        int label_match = gen_new_label();
3764
 
        label_continue = gen_new_label();
3765
 
        arm_gen_test_cc(cond, label_match);
3766
 
        /* nomatch: */
3767
 
        tcg_flags = tcg_const_i64(nzcv << 28);
3768
 
        gen_set_nzcv(tcg_flags);
3769
 
        tcg_temp_free_i64(tcg_flags);
3770
 
        tcg_gen_br(label_continue);
3771
 
        gen_set_label(label_match);
3772
 
    }
3773
 
 
3774
 
    handle_fp_compare(s, type, rn, rm, false, op);
3775
 
 
3776
 
    if (cond < 0x0e) {
3777
 
        gen_set_label(label_continue);
3778
 
    }
3779
 
}
3780
 
 
3781
 
/* copy src FP register to dst FP register; type specifies single or double */
3782
 
static void gen_mov_fp2fp(DisasContext *s, int type, int dst, int src)
3783
 
{
3784
 
    if (type) {
3785
 
        TCGv_i64 v = read_fp_dreg(s, src);
3786
 
        write_fp_dreg(s, dst, v);
3787
 
        tcg_temp_free_i64(v);
3788
 
    } else {
3789
 
        TCGv_i32 v = read_fp_sreg(s, src);
3790
 
        write_fp_sreg(s, dst, v);
3791
 
        tcg_temp_free_i32(v);
3792
 
    }
3793
 
}
3794
 
 
3795
 
/* C3.6.24 Floating point conditional select
3796
 
 *   31  30  29 28       24 23  22  21 20  16 15  12 11 10 9    5 4    0
3797
 
 * +---+---+---+-----------+------+---+------+------+-----+------+------+
3798
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 |  Rm  | cond | 1 1 |  Rn  |  Rd  |
3799
 
 * +---+---+---+-----------+------+---+------+------+-----+------+------+
3800
 
 */
3801
 
static void disas_fp_csel(DisasContext *s, uint32_t insn)
3802
 
{
3803
 
    unsigned int mos, type, rm, cond, rn, rd;
3804
 
    int label_continue = -1;
3805
 
 
3806
 
    mos = extract32(insn, 29, 3);
3807
 
    type = extract32(insn, 22, 2); /* 0 = single, 1 = double */
3808
 
    rm = extract32(insn, 16, 5);
3809
 
    cond = extract32(insn, 12, 4);
3810
 
    rn = extract32(insn, 5, 5);
3811
 
    rd = extract32(insn, 0, 5);
3812
 
 
3813
 
    if (mos || type > 1) {
3814
 
        unallocated_encoding(s);
3815
 
        return;
3816
 
    }
3817
 
 
3818
 
    if (cond < 0x0e) { /* not always */
3819
 
        int label_match = gen_new_label();
3820
 
        label_continue = gen_new_label();
3821
 
        arm_gen_test_cc(cond, label_match);
3822
 
        /* nomatch: */
3823
 
        gen_mov_fp2fp(s, type, rd, rm);
3824
 
        tcg_gen_br(label_continue);
3825
 
        gen_set_label(label_match);
3826
 
    }
3827
 
 
3828
 
    gen_mov_fp2fp(s, type, rd, rn);
3829
 
 
3830
 
    if (cond < 0x0e) { /* continue */
3831
 
        gen_set_label(label_continue);
3832
 
    }
3833
 
}
3834
 
 
3835
 
/* C3.6.25 Floating-point data-processing (1 source) - single precision */
3836
 
static void handle_fp_1src_single(DisasContext *s, int opcode, int rd, int rn)
3837
 
{
3838
 
    TCGv_ptr fpst;
3839
 
    TCGv_i32 tcg_op;
3840
 
    TCGv_i32 tcg_res;
3841
 
 
3842
 
    fpst = get_fpstatus_ptr();
3843
 
    tcg_op = read_fp_sreg(s, rn);
3844
 
    tcg_res = tcg_temp_new_i32();
3845
 
 
3846
 
    switch (opcode) {
3847
 
    case 0x0: /* FMOV */
3848
 
        tcg_gen_mov_i32(tcg_res, tcg_op);
3849
 
        break;
3850
 
    case 0x1: /* FABS */
3851
 
        gen_helper_vfp_abss(tcg_res, tcg_op);
3852
 
        break;
3853
 
    case 0x2: /* FNEG */
3854
 
        gen_helper_vfp_negs(tcg_res, tcg_op);
3855
 
        break;
3856
 
    case 0x3: /* FSQRT */
3857
 
        gen_helper_vfp_sqrts(tcg_res, tcg_op, cpu_env);
3858
 
        break;
3859
 
    case 0x8: /* FRINTN */
3860
 
    case 0x9: /* FRINTP */
3861
 
    case 0xa: /* FRINTM */
3862
 
    case 0xb: /* FRINTZ */
3863
 
    case 0xc: /* FRINTA */
3864
 
    {
3865
 
        TCGv_i32 tcg_rmode = tcg_const_i32(arm_rmode_to_sf(opcode & 7));
3866
 
 
3867
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
3868
 
        gen_helper_rints(tcg_res, tcg_op, fpst);
3869
 
 
3870
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
3871
 
        tcg_temp_free_i32(tcg_rmode);
3872
 
        break;
3873
 
    }
3874
 
    case 0xe: /* FRINTX */
3875
 
        gen_helper_rints_exact(tcg_res, tcg_op, fpst);
3876
 
        break;
3877
 
    case 0xf: /* FRINTI */
3878
 
        gen_helper_rints(tcg_res, tcg_op, fpst);
3879
 
        break;
3880
 
    default:
3881
 
        abort();
3882
 
    }
3883
 
 
3884
 
    write_fp_sreg(s, rd, tcg_res);
3885
 
 
3886
 
    tcg_temp_free_ptr(fpst);
3887
 
    tcg_temp_free_i32(tcg_op);
3888
 
    tcg_temp_free_i32(tcg_res);
3889
 
}
3890
 
 
3891
 
/* C3.6.25 Floating-point data-processing (1 source) - double precision */
3892
 
static void handle_fp_1src_double(DisasContext *s, int opcode, int rd, int rn)
3893
 
{
3894
 
    TCGv_ptr fpst;
3895
 
    TCGv_i64 tcg_op;
3896
 
    TCGv_i64 tcg_res;
3897
 
 
3898
 
    fpst = get_fpstatus_ptr();
3899
 
    tcg_op = read_fp_dreg(s, rn);
3900
 
    tcg_res = tcg_temp_new_i64();
3901
 
 
3902
 
    switch (opcode) {
3903
 
    case 0x0: /* FMOV */
3904
 
        tcg_gen_mov_i64(tcg_res, tcg_op);
3905
 
        break;
3906
 
    case 0x1: /* FABS */
3907
 
        gen_helper_vfp_absd(tcg_res, tcg_op);
3908
 
        break;
3909
 
    case 0x2: /* FNEG */
3910
 
        gen_helper_vfp_negd(tcg_res, tcg_op);
3911
 
        break;
3912
 
    case 0x3: /* FSQRT */
3913
 
        gen_helper_vfp_sqrtd(tcg_res, tcg_op, cpu_env);
3914
 
        break;
3915
 
    case 0x8: /* FRINTN */
3916
 
    case 0x9: /* FRINTP */
3917
 
    case 0xa: /* FRINTM */
3918
 
    case 0xb: /* FRINTZ */
3919
 
    case 0xc: /* FRINTA */
3920
 
    {
3921
 
        TCGv_i32 tcg_rmode = tcg_const_i32(arm_rmode_to_sf(opcode & 7));
3922
 
 
3923
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
3924
 
        gen_helper_rintd(tcg_res, tcg_op, fpst);
3925
 
 
3926
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
3927
 
        tcg_temp_free_i32(tcg_rmode);
3928
 
        break;
3929
 
    }
3930
 
    case 0xe: /* FRINTX */
3931
 
        gen_helper_rintd_exact(tcg_res, tcg_op, fpst);
3932
 
        break;
3933
 
    case 0xf: /* FRINTI */
3934
 
        gen_helper_rintd(tcg_res, tcg_op, fpst);
3935
 
        break;
3936
 
    default:
3937
 
        abort();
3938
 
    }
3939
 
 
3940
 
    write_fp_dreg(s, rd, tcg_res);
3941
 
 
3942
 
    tcg_temp_free_ptr(fpst);
3943
 
    tcg_temp_free_i64(tcg_op);
3944
 
    tcg_temp_free_i64(tcg_res);
3945
 
}
3946
 
 
3947
 
static void handle_fp_fcvt(DisasContext *s, int opcode,
3948
 
                           int rd, int rn, int dtype, int ntype)
3949
 
{
3950
 
    switch (ntype) {
3951
 
    case 0x0:
3952
 
    {
3953
 
        TCGv_i32 tcg_rn = read_fp_sreg(s, rn);
3954
 
        if (dtype == 1) {
3955
 
            /* Single to double */
3956
 
            TCGv_i64 tcg_rd = tcg_temp_new_i64();
3957
 
            gen_helper_vfp_fcvtds(tcg_rd, tcg_rn, cpu_env);
3958
 
            write_fp_dreg(s, rd, tcg_rd);
3959
 
            tcg_temp_free_i64(tcg_rd);
3960
 
        } else {
3961
 
            /* Single to half */
3962
 
            TCGv_i32 tcg_rd = tcg_temp_new_i32();
3963
 
            gen_helper_vfp_fcvt_f32_to_f16(tcg_rd, tcg_rn, cpu_env);
3964
 
            /* write_fp_sreg is OK here because top half of tcg_rd is zero */
3965
 
            write_fp_sreg(s, rd, tcg_rd);
3966
 
            tcg_temp_free_i32(tcg_rd);
3967
 
        }
3968
 
        tcg_temp_free_i32(tcg_rn);
3969
 
        break;
3970
 
    }
3971
 
    case 0x1:
3972
 
    {
3973
 
        TCGv_i64 tcg_rn = read_fp_dreg(s, rn);
3974
 
        TCGv_i32 tcg_rd = tcg_temp_new_i32();
3975
 
        if (dtype == 0) {
3976
 
            /* Double to single */
3977
 
            gen_helper_vfp_fcvtsd(tcg_rd, tcg_rn, cpu_env);
3978
 
        } else {
3979
 
            /* Double to half */
3980
 
            gen_helper_vfp_fcvt_f64_to_f16(tcg_rd, tcg_rn, cpu_env);
3981
 
            /* write_fp_sreg is OK here because top half of tcg_rd is zero */
3982
 
        }
3983
 
        write_fp_sreg(s, rd, tcg_rd);
3984
 
        tcg_temp_free_i32(tcg_rd);
3985
 
        tcg_temp_free_i64(tcg_rn);
3986
 
        break;
3987
 
    }
3988
 
    case 0x3:
3989
 
    {
3990
 
        TCGv_i32 tcg_rn = read_fp_sreg(s, rn);
3991
 
        tcg_gen_ext16u_i32(tcg_rn, tcg_rn);
3992
 
        if (dtype == 0) {
3993
 
            /* Half to single */
3994
 
            TCGv_i32 tcg_rd = tcg_temp_new_i32();
3995
 
            gen_helper_vfp_fcvt_f16_to_f32(tcg_rd, tcg_rn, cpu_env);
3996
 
            write_fp_sreg(s, rd, tcg_rd);
3997
 
            tcg_temp_free_i32(tcg_rd);
3998
 
        } else {
3999
 
            /* Half to double */
4000
 
            TCGv_i64 tcg_rd = tcg_temp_new_i64();
4001
 
            gen_helper_vfp_fcvt_f16_to_f64(tcg_rd, tcg_rn, cpu_env);
4002
 
            write_fp_dreg(s, rd, tcg_rd);
4003
 
            tcg_temp_free_i64(tcg_rd);
4004
 
        }
4005
 
        tcg_temp_free_i32(tcg_rn);
4006
 
        break;
4007
 
    }
4008
 
    default:
4009
 
        abort();
4010
 
    }
4011
 
}
4012
 
 
4013
 
/* C3.6.25 Floating point data-processing (1 source)
4014
 
 *   31  30  29 28       24 23  22  21 20    15 14       10 9    5 4    0
4015
 
 * +---+---+---+-----------+------+---+--------+-----------+------+------+
4016
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 | opcode | 1 0 0 0 0 |  Rn  |  Rd  |
4017
 
 * +---+---+---+-----------+------+---+--------+-----------+------+------+
4018
 
 */
4019
 
static void disas_fp_1src(DisasContext *s, uint32_t insn)
4020
 
{
4021
 
    int type = extract32(insn, 22, 2);
4022
 
    int opcode = extract32(insn, 15, 6);
4023
 
    int rn = extract32(insn, 5, 5);
4024
 
    int rd = extract32(insn, 0, 5);
4025
 
 
4026
 
    switch (opcode) {
4027
 
    case 0x4: case 0x5: case 0x7:
4028
 
    {
4029
 
        /* FCVT between half, single and double precision */
4030
 
        int dtype = extract32(opcode, 0, 2);
4031
 
        if (type == 2 || dtype == type) {
4032
 
            unallocated_encoding(s);
4033
 
            return;
4034
 
        }
4035
 
        handle_fp_fcvt(s, opcode, rd, rn, dtype, type);
4036
 
        break;
4037
 
    }
4038
 
    case 0x0 ... 0x3:
4039
 
    case 0x8 ... 0xc:
4040
 
    case 0xe ... 0xf:
4041
 
        /* 32-to-32 and 64-to-64 ops */
4042
 
        switch (type) {
4043
 
        case 0:
4044
 
            handle_fp_1src_single(s, opcode, rd, rn);
4045
 
            break;
4046
 
        case 1:
4047
 
            handle_fp_1src_double(s, opcode, rd, rn);
4048
 
            break;
4049
 
        default:
4050
 
            unallocated_encoding(s);
4051
 
        }
4052
 
        break;
4053
 
    default:
4054
 
        unallocated_encoding(s);
4055
 
        break;
4056
 
    }
4057
 
}
4058
 
 
4059
 
/* C3.6.26 Floating-point data-processing (2 source) - single precision */
4060
 
static void handle_fp_2src_single(DisasContext *s, int opcode,
4061
 
                                  int rd, int rn, int rm)
4062
 
{
4063
 
    TCGv_i32 tcg_op1;
4064
 
    TCGv_i32 tcg_op2;
4065
 
    TCGv_i32 tcg_res;
4066
 
    TCGv_ptr fpst;
4067
 
 
4068
 
    tcg_res = tcg_temp_new_i32();
4069
 
    fpst = get_fpstatus_ptr();
4070
 
    tcg_op1 = read_fp_sreg(s, rn);
4071
 
    tcg_op2 = read_fp_sreg(s, rm);
4072
 
 
4073
 
    switch (opcode) {
4074
 
    case 0x0: /* FMUL */
4075
 
        gen_helper_vfp_muls(tcg_res, tcg_op1, tcg_op2, fpst);
4076
 
        break;
4077
 
    case 0x1: /* FDIV */
4078
 
        gen_helper_vfp_divs(tcg_res, tcg_op1, tcg_op2, fpst);
4079
 
        break;
4080
 
    case 0x2: /* FADD */
4081
 
        gen_helper_vfp_adds(tcg_res, tcg_op1, tcg_op2, fpst);
4082
 
        break;
4083
 
    case 0x3: /* FSUB */
4084
 
        gen_helper_vfp_subs(tcg_res, tcg_op1, tcg_op2, fpst);
4085
 
        break;
4086
 
    case 0x4: /* FMAX */
4087
 
        gen_helper_vfp_maxs(tcg_res, tcg_op1, tcg_op2, fpst);
4088
 
        break;
4089
 
    case 0x5: /* FMIN */
4090
 
        gen_helper_vfp_mins(tcg_res, tcg_op1, tcg_op2, fpst);
4091
 
        break;
4092
 
    case 0x6: /* FMAXNM */
4093
 
        gen_helper_vfp_maxnums(tcg_res, tcg_op1, tcg_op2, fpst);
4094
 
        break;
4095
 
    case 0x7: /* FMINNM */
4096
 
        gen_helper_vfp_minnums(tcg_res, tcg_op1, tcg_op2, fpst);
4097
 
        break;
4098
 
    case 0x8: /* FNMUL */
4099
 
        gen_helper_vfp_muls(tcg_res, tcg_op1, tcg_op2, fpst);
4100
 
        gen_helper_vfp_negs(tcg_res, tcg_res);
4101
 
        break;
4102
 
    }
4103
 
 
4104
 
    write_fp_sreg(s, rd, tcg_res);
4105
 
 
4106
 
    tcg_temp_free_ptr(fpst);
4107
 
    tcg_temp_free_i32(tcg_op1);
4108
 
    tcg_temp_free_i32(tcg_op2);
4109
 
    tcg_temp_free_i32(tcg_res);
4110
 
}
4111
 
 
4112
 
/* C3.6.26 Floating-point data-processing (2 source) - double precision */
4113
 
static void handle_fp_2src_double(DisasContext *s, int opcode,
4114
 
                                  int rd, int rn, int rm)
4115
 
{
4116
 
    TCGv_i64 tcg_op1;
4117
 
    TCGv_i64 tcg_op2;
4118
 
    TCGv_i64 tcg_res;
4119
 
    TCGv_ptr fpst;
4120
 
 
4121
 
    tcg_res = tcg_temp_new_i64();
4122
 
    fpst = get_fpstatus_ptr();
4123
 
    tcg_op1 = read_fp_dreg(s, rn);
4124
 
    tcg_op2 = read_fp_dreg(s, rm);
4125
 
 
4126
 
    switch (opcode) {
4127
 
    case 0x0: /* FMUL */
4128
 
        gen_helper_vfp_muld(tcg_res, tcg_op1, tcg_op2, fpst);
4129
 
        break;
4130
 
    case 0x1: /* FDIV */
4131
 
        gen_helper_vfp_divd(tcg_res, tcg_op1, tcg_op2, fpst);
4132
 
        break;
4133
 
    case 0x2: /* FADD */
4134
 
        gen_helper_vfp_addd(tcg_res, tcg_op1, tcg_op2, fpst);
4135
 
        break;
4136
 
    case 0x3: /* FSUB */
4137
 
        gen_helper_vfp_subd(tcg_res, tcg_op1, tcg_op2, fpst);
4138
 
        break;
4139
 
    case 0x4: /* FMAX */
4140
 
        gen_helper_vfp_maxd(tcg_res, tcg_op1, tcg_op2, fpst);
4141
 
        break;
4142
 
    case 0x5: /* FMIN */
4143
 
        gen_helper_vfp_mind(tcg_res, tcg_op1, tcg_op2, fpst);
4144
 
        break;
4145
 
    case 0x6: /* FMAXNM */
4146
 
        gen_helper_vfp_maxnumd(tcg_res, tcg_op1, tcg_op2, fpst);
4147
 
        break;
4148
 
    case 0x7: /* FMINNM */
4149
 
        gen_helper_vfp_minnumd(tcg_res, tcg_op1, tcg_op2, fpst);
4150
 
        break;
4151
 
    case 0x8: /* FNMUL */
4152
 
        gen_helper_vfp_muld(tcg_res, tcg_op1, tcg_op2, fpst);
4153
 
        gen_helper_vfp_negd(tcg_res, tcg_res);
4154
 
        break;
4155
 
    }
4156
 
 
4157
 
    write_fp_dreg(s, rd, tcg_res);
4158
 
 
4159
 
    tcg_temp_free_ptr(fpst);
4160
 
    tcg_temp_free_i64(tcg_op1);
4161
 
    tcg_temp_free_i64(tcg_op2);
4162
 
    tcg_temp_free_i64(tcg_res);
4163
 
}
4164
 
 
4165
 
/* C3.6.26 Floating point data-processing (2 source)
4166
 
 *   31  30  29 28       24 23  22  21 20  16 15    12 11 10 9    5 4    0
4167
 
 * +---+---+---+-----------+------+---+------+--------+-----+------+------+
4168
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 |  Rm  | opcode | 1 0 |  Rn  |  Rd  |
4169
 
 * +---+---+---+-----------+------+---+------+--------+-----+------+------+
4170
 
 */
4171
 
static void disas_fp_2src(DisasContext *s, uint32_t insn)
4172
 
{
4173
 
    int type = extract32(insn, 22, 2);
4174
 
    int rd = extract32(insn, 0, 5);
4175
 
    int rn = extract32(insn, 5, 5);
4176
 
    int rm = extract32(insn, 16, 5);
4177
 
    int opcode = extract32(insn, 12, 4);
4178
 
 
4179
 
    if (opcode > 8) {
4180
 
        unallocated_encoding(s);
4181
 
        return;
4182
 
    }
4183
 
 
4184
 
    switch (type) {
4185
 
    case 0:
4186
 
        handle_fp_2src_single(s, opcode, rd, rn, rm);
4187
 
        break;
4188
 
    case 1:
4189
 
        handle_fp_2src_double(s, opcode, rd, rn, rm);
4190
 
        break;
4191
 
    default:
4192
 
        unallocated_encoding(s);
4193
 
    }
4194
 
}
4195
 
 
4196
 
/* C3.6.27 Floating-point data-processing (3 source) - single precision */
4197
 
static void handle_fp_3src_single(DisasContext *s, bool o0, bool o1,
4198
 
                                  int rd, int rn, int rm, int ra)
4199
 
{
4200
 
    TCGv_i32 tcg_op1, tcg_op2, tcg_op3;
4201
 
    TCGv_i32 tcg_res = tcg_temp_new_i32();
4202
 
    TCGv_ptr fpst = get_fpstatus_ptr();
4203
 
 
4204
 
    tcg_op1 = read_fp_sreg(s, rn);
4205
 
    tcg_op2 = read_fp_sreg(s, rm);
4206
 
    tcg_op3 = read_fp_sreg(s, ra);
4207
 
 
4208
 
    /* These are fused multiply-add, and must be done as one
4209
 
     * floating point operation with no rounding between the
4210
 
     * multiplication and addition steps.
4211
 
     * NB that doing the negations here as separate steps is
4212
 
     * correct : an input NaN should come out with its sign bit
4213
 
     * flipped if it is a negated-input.
4214
 
     */
4215
 
    if (o1 == true) {
4216
 
        gen_helper_vfp_negs(tcg_op3, tcg_op3);
4217
 
    }
4218
 
 
4219
 
    if (o0 != o1) {
4220
 
        gen_helper_vfp_negs(tcg_op1, tcg_op1);
4221
 
    }
4222
 
 
4223
 
    gen_helper_vfp_muladds(tcg_res, tcg_op1, tcg_op2, tcg_op3, fpst);
4224
 
 
4225
 
    write_fp_sreg(s, rd, tcg_res);
4226
 
 
4227
 
    tcg_temp_free_ptr(fpst);
4228
 
    tcg_temp_free_i32(tcg_op1);
4229
 
    tcg_temp_free_i32(tcg_op2);
4230
 
    tcg_temp_free_i32(tcg_op3);
4231
 
    tcg_temp_free_i32(tcg_res);
4232
 
}
4233
 
 
4234
 
/* C3.6.27 Floating-point data-processing (3 source) - double precision */
4235
 
static void handle_fp_3src_double(DisasContext *s, bool o0, bool o1,
4236
 
                                  int rd, int rn, int rm, int ra)
4237
 
{
4238
 
    TCGv_i64 tcg_op1, tcg_op2, tcg_op3;
4239
 
    TCGv_i64 tcg_res = tcg_temp_new_i64();
4240
 
    TCGv_ptr fpst = get_fpstatus_ptr();
4241
 
 
4242
 
    tcg_op1 = read_fp_dreg(s, rn);
4243
 
    tcg_op2 = read_fp_dreg(s, rm);
4244
 
    tcg_op3 = read_fp_dreg(s, ra);
4245
 
 
4246
 
    /* These are fused multiply-add, and must be done as one
4247
 
     * floating point operation with no rounding between the
4248
 
     * multiplication and addition steps.
4249
 
     * NB that doing the negations here as separate steps is
4250
 
     * correct : an input NaN should come out with its sign bit
4251
 
     * flipped if it is a negated-input.
4252
 
     */
4253
 
    if (o1 == true) {
4254
 
        gen_helper_vfp_negd(tcg_op3, tcg_op3);
4255
 
    }
4256
 
 
4257
 
    if (o0 != o1) {
4258
 
        gen_helper_vfp_negd(tcg_op1, tcg_op1);
4259
 
    }
4260
 
 
4261
 
    gen_helper_vfp_muladdd(tcg_res, tcg_op1, tcg_op2, tcg_op3, fpst);
4262
 
 
4263
 
    write_fp_dreg(s, rd, tcg_res);
4264
 
 
4265
 
    tcg_temp_free_ptr(fpst);
4266
 
    tcg_temp_free_i64(tcg_op1);
4267
 
    tcg_temp_free_i64(tcg_op2);
4268
 
    tcg_temp_free_i64(tcg_op3);
4269
 
    tcg_temp_free_i64(tcg_res);
4270
 
}
4271
 
 
4272
 
/* C3.6.27 Floating point data-processing (3 source)
4273
 
 *   31  30  29 28       24 23  22  21  20  16  15  14  10 9    5 4    0
4274
 
 * +---+---+---+-----------+------+----+------+----+------+------+------+
4275
 
 * | M | 0 | S | 1 1 1 1 1 | type | o1 |  Rm  | o0 |  Ra  |  Rn  |  Rd  |
4276
 
 * +---+---+---+-----------+------+----+------+----+------+------+------+
4277
 
 */
4278
 
static void disas_fp_3src(DisasContext *s, uint32_t insn)
4279
 
{
4280
 
    int type = extract32(insn, 22, 2);
4281
 
    int rd = extract32(insn, 0, 5);
4282
 
    int rn = extract32(insn, 5, 5);
4283
 
    int ra = extract32(insn, 10, 5);
4284
 
    int rm = extract32(insn, 16, 5);
4285
 
    bool o0 = extract32(insn, 15, 1);
4286
 
    bool o1 = extract32(insn, 21, 1);
4287
 
 
4288
 
    switch (type) {
4289
 
    case 0:
4290
 
        handle_fp_3src_single(s, o0, o1, rd, rn, rm, ra);
4291
 
        break;
4292
 
    case 1:
4293
 
        handle_fp_3src_double(s, o0, o1, rd, rn, rm, ra);
4294
 
        break;
4295
 
    default:
4296
 
        unallocated_encoding(s);
4297
 
    }
4298
 
}
4299
 
 
4300
 
/* C3.6.28 Floating point immediate
4301
 
 *   31  30  29 28       24 23  22  21 20        13 12   10 9    5 4    0
4302
 
 * +---+---+---+-----------+------+---+------------+-------+------+------+
4303
 
 * | M | 0 | S | 1 1 1 1 0 | type | 1 |    imm8    | 1 0 0 | imm5 |  Rd  |
4304
 
 * +---+---+---+-----------+------+---+------------+-------+------+------+
4305
 
 */
4306
 
static void disas_fp_imm(DisasContext *s, uint32_t insn)
4307
 
{
4308
 
    int rd = extract32(insn, 0, 5);
4309
 
    int imm8 = extract32(insn, 13, 8);
4310
 
    int is_double = extract32(insn, 22, 2);
4311
 
    uint64_t imm;
4312
 
    TCGv_i64 tcg_res;
4313
 
 
4314
 
    if (is_double > 1) {
4315
 
        unallocated_encoding(s);
4316
 
        return;
4317
 
    }
4318
 
 
4319
 
    /* The imm8 encodes the sign bit, enough bits to represent
4320
 
     * an exponent in the range 01....1xx to 10....0xx,
4321
 
     * and the most significant 4 bits of the mantissa; see
4322
 
     * VFPExpandImm() in the v8 ARM ARM.
4323
 
     */
4324
 
    if (is_double) {
4325
 
        imm = (extract32(imm8, 7, 1) ? 0x8000 : 0) |
4326
 
            (extract32(imm8, 6, 1) ? 0x3fc0 : 0x4000) |
4327
 
            extract32(imm8, 0, 6);
4328
 
        imm <<= 48;
4329
 
    } else {
4330
 
        imm = (extract32(imm8, 7, 1) ? 0x8000 : 0) |
4331
 
            (extract32(imm8, 6, 1) ? 0x3e00 : 0x4000) |
4332
 
            (extract32(imm8, 0, 6) << 3);
4333
 
        imm <<= 16;
4334
 
    }
4335
 
 
4336
 
    tcg_res = tcg_const_i64(imm);
4337
 
    write_fp_dreg(s, rd, tcg_res);
4338
 
    tcg_temp_free_i64(tcg_res);
4339
 
}
4340
 
 
4341
 
/* Handle floating point <=> fixed point conversions. Note that we can
4342
 
 * also deal with fp <=> integer conversions as a special case (scale == 64)
4343
 
 * OPTME: consider handling that special case specially or at least skipping
4344
 
 * the call to scalbn in the helpers for zero shifts.
4345
 
 */
4346
 
static void handle_fpfpcvt(DisasContext *s, int rd, int rn, int opcode,
4347
 
                           bool itof, int rmode, int scale, int sf, int type)
4348
 
{
4349
 
    bool is_signed = !(opcode & 1);
4350
 
    bool is_double = type;
4351
 
    TCGv_ptr tcg_fpstatus;
4352
 
    TCGv_i32 tcg_shift;
4353
 
 
4354
 
    tcg_fpstatus = get_fpstatus_ptr();
4355
 
 
4356
 
    tcg_shift = tcg_const_i32(64 - scale);
4357
 
 
4358
 
    if (itof) {
4359
 
        TCGv_i64 tcg_int = cpu_reg(s, rn);
4360
 
        if (!sf) {
4361
 
            TCGv_i64 tcg_extend = new_tmp_a64(s);
4362
 
 
4363
 
            if (is_signed) {
4364
 
                tcg_gen_ext32s_i64(tcg_extend, tcg_int);
4365
 
            } else {
4366
 
                tcg_gen_ext32u_i64(tcg_extend, tcg_int);
4367
 
            }
4368
 
 
4369
 
            tcg_int = tcg_extend;
4370
 
        }
4371
 
 
4372
 
        if (is_double) {
4373
 
            TCGv_i64 tcg_double = tcg_temp_new_i64();
4374
 
            if (is_signed) {
4375
 
                gen_helper_vfp_sqtod(tcg_double, tcg_int,
4376
 
                                     tcg_shift, tcg_fpstatus);
4377
 
            } else {
4378
 
                gen_helper_vfp_uqtod(tcg_double, tcg_int,
4379
 
                                     tcg_shift, tcg_fpstatus);
4380
 
            }
4381
 
            write_fp_dreg(s, rd, tcg_double);
4382
 
            tcg_temp_free_i64(tcg_double);
4383
 
        } else {
4384
 
            TCGv_i32 tcg_single = tcg_temp_new_i32();
4385
 
            if (is_signed) {
4386
 
                gen_helper_vfp_sqtos(tcg_single, tcg_int,
4387
 
                                     tcg_shift, tcg_fpstatus);
4388
 
            } else {
4389
 
                gen_helper_vfp_uqtos(tcg_single, tcg_int,
4390
 
                                     tcg_shift, tcg_fpstatus);
4391
 
            }
4392
 
            write_fp_sreg(s, rd, tcg_single);
4393
 
            tcg_temp_free_i32(tcg_single);
4394
 
        }
4395
 
    } else {
4396
 
        TCGv_i64 tcg_int = cpu_reg(s, rd);
4397
 
        TCGv_i32 tcg_rmode;
4398
 
 
4399
 
        if (extract32(opcode, 2, 1)) {
4400
 
            /* There are too many rounding modes to all fit into rmode,
4401
 
             * so FCVTA[US] is a special case.
4402
 
             */
4403
 
            rmode = FPROUNDING_TIEAWAY;
4404
 
        }
4405
 
 
4406
 
        tcg_rmode = tcg_const_i32(arm_rmode_to_sf(rmode));
4407
 
 
4408
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
4409
 
 
4410
 
        if (is_double) {
4411
 
            TCGv_i64 tcg_double = read_fp_dreg(s, rn);
4412
 
            if (is_signed) {
4413
 
                if (!sf) {
4414
 
                    gen_helper_vfp_tosld(tcg_int, tcg_double,
4415
 
                                         tcg_shift, tcg_fpstatus);
4416
 
                } else {
4417
 
                    gen_helper_vfp_tosqd(tcg_int, tcg_double,
4418
 
                                         tcg_shift, tcg_fpstatus);
4419
 
                }
4420
 
            } else {
4421
 
                if (!sf) {
4422
 
                    gen_helper_vfp_tould(tcg_int, tcg_double,
4423
 
                                         tcg_shift, tcg_fpstatus);
4424
 
                } else {
4425
 
                    gen_helper_vfp_touqd(tcg_int, tcg_double,
4426
 
                                         tcg_shift, tcg_fpstatus);
4427
 
                }
4428
 
            }
4429
 
            tcg_temp_free_i64(tcg_double);
4430
 
        } else {
4431
 
            TCGv_i32 tcg_single = read_fp_sreg(s, rn);
4432
 
            if (sf) {
4433
 
                if (is_signed) {
4434
 
                    gen_helper_vfp_tosqs(tcg_int, tcg_single,
4435
 
                                         tcg_shift, tcg_fpstatus);
4436
 
                } else {
4437
 
                    gen_helper_vfp_touqs(tcg_int, tcg_single,
4438
 
                                         tcg_shift, tcg_fpstatus);
4439
 
                }
4440
 
            } else {
4441
 
                TCGv_i32 tcg_dest = tcg_temp_new_i32();
4442
 
                if (is_signed) {
4443
 
                    gen_helper_vfp_tosls(tcg_dest, tcg_single,
4444
 
                                         tcg_shift, tcg_fpstatus);
4445
 
                } else {
4446
 
                    gen_helper_vfp_touls(tcg_dest, tcg_single,
4447
 
                                         tcg_shift, tcg_fpstatus);
4448
 
                }
4449
 
                tcg_gen_extu_i32_i64(tcg_int, tcg_dest);
4450
 
                tcg_temp_free_i32(tcg_dest);
4451
 
            }
4452
 
            tcg_temp_free_i32(tcg_single);
4453
 
        }
4454
 
 
4455
 
        gen_helper_set_rmode(tcg_rmode, tcg_rmode, cpu_env);
4456
 
        tcg_temp_free_i32(tcg_rmode);
4457
 
 
4458
 
        if (!sf) {
4459
 
            tcg_gen_ext32u_i64(tcg_int, tcg_int);
4460
 
        }
4461
 
    }
4462
 
 
4463
 
    tcg_temp_free_ptr(tcg_fpstatus);
4464
 
    tcg_temp_free_i32(tcg_shift);
4465
 
}
4466
 
 
4467
 
/* C3.6.29 Floating point <-> fixed point conversions
4468
 
 *   31   30  29 28       24 23  22  21 20   19 18    16 15   10 9    5 4    0
4469
 
 * +----+---+---+-----------+------+---+-------+--------+-------+------+------+
4470
 
 * | sf | 0 | S | 1 1 1 1 0 | type | 0 | rmode | opcode | scale |  Rn  |  Rd  |
4471
 
 * +----+---+---+-----------+------+---+-------+--------+-------+------+------+
4472
 
 */
4473
 
static void disas_fp_fixed_conv(DisasContext *s, uint32_t insn)
4474
 
{
4475
 
    int rd = extract32(insn, 0, 5);
4476
 
    int rn = extract32(insn, 5, 5);
4477
 
    int scale = extract32(insn, 10, 6);
4478
 
    int opcode = extract32(insn, 16, 3);
4479
 
    int rmode = extract32(insn, 19, 2);
4480
 
    int type = extract32(insn, 22, 2);
4481
 
    bool sbit = extract32(insn, 29, 1);
4482
 
    bool sf = extract32(insn, 31, 1);
4483
 
    bool itof;
4484
 
 
4485
 
    if (sbit || (type > 1)
4486
 
        || (!sf && scale < 32)) {
4487
 
        unallocated_encoding(s);
4488
 
        return;
4489
 
    }
4490
 
 
4491
 
    switch ((rmode << 3) | opcode) {
4492
 
    case 0x2: /* SCVTF */
4493
 
    case 0x3: /* UCVTF */
4494
 
        itof = true;
4495
 
        break;
4496
 
    case 0x18: /* FCVTZS */
4497
 
    case 0x19: /* FCVTZU */
4498
 
        itof = false;
4499
 
        break;
4500
 
    default:
4501
 
        unallocated_encoding(s);
4502
 
        return;
4503
 
    }
4504
 
 
4505
 
    handle_fpfpcvt(s, rd, rn, opcode, itof, FPROUNDING_ZERO, scale, sf, type);
4506
 
}
4507
 
 
4508
 
static void handle_fmov(DisasContext *s, int rd, int rn, int type, bool itof)
4509
 
{
4510
 
    /* FMOV: gpr to or from float, double, or top half of quad fp reg,
4511
 
     * without conversion.
4512
 
     */
4513
 
 
4514
 
    if (itof) {
4515
 
        TCGv_i64 tcg_rn = cpu_reg(s, rn);
4516
 
 
4517
 
        switch (type) {
4518
 
        case 0:
4519
 
        {
4520
 
            /* 32 bit */
4521
 
            TCGv_i64 tmp = tcg_temp_new_i64();
4522
 
            tcg_gen_ext32u_i64(tmp, tcg_rn);
4523
 
            tcg_gen_st_i64(tmp, cpu_env, fp_reg_offset(rd, MO_64));
4524
 
            tcg_gen_movi_i64(tmp, 0);
4525
 
            tcg_gen_st_i64(tmp, cpu_env, fp_reg_hi_offset(rd));
4526
 
            tcg_temp_free_i64(tmp);
4527
 
            break;
4528
 
        }
4529
 
        case 1:
4530
 
        {
4531
 
            /* 64 bit */
4532
 
            TCGv_i64 tmp = tcg_const_i64(0);
4533
 
            tcg_gen_st_i64(tcg_rn, cpu_env, fp_reg_offset(rd, MO_64));
4534
 
            tcg_gen_st_i64(tmp, cpu_env, fp_reg_hi_offset(rd));
4535
 
            tcg_temp_free_i64(tmp);
4536
 
            break;
4537
 
        }
4538
 
        case 2:
4539
 
            /* 64 bit to top half. */
4540
 
            tcg_gen_st_i64(tcg_rn, cpu_env, fp_reg_hi_offset(rd));
4541
 
            break;
4542
 
        }
4543
 
    } else {
4544
 
        TCGv_i64 tcg_rd = cpu_reg(s, rd);
4545
 
 
4546
 
        switch (type) {
4547
 
        case 0:
4548
 
            /* 32 bit */
4549
 
            tcg_gen_ld32u_i64(tcg_rd, cpu_env, fp_reg_offset(rn, MO_32));
4550
 
            break;
4551
 
        case 1:
4552
 
            /* 64 bit */
4553
 
            tcg_gen_ld_i64(tcg_rd, cpu_env, fp_reg_offset(rn, MO_64));
4554
 
            break;
4555
 
        case 2:
4556
 
            /* 64 bits from top half */
4557
 
            tcg_gen_ld_i64(tcg_rd, cpu_env, fp_reg_hi_offset(rn));
4558
 
            break;
4559
 
        }
4560
 
    }
4561
 
}
4562
 
 
4563
 
/* C3.6.30 Floating point <-> integer conversions
4564
 
 *   31   30  29 28       24 23  22  21 20   19 18 16 15         10 9  5 4  0
4565
 
 * +----+---+---+-----------+------+---+-------+-----+-------------+----+----+
4566
 
 * | sf | 0 | S | 1 1 1 1 0 | type | 1 | rmode | opc | 0 0 0 0 0 0 | Rn | Rd |
4567
 
 * +----+---+---+-----------+------+---+-------+-----+-------------+----+----+
4568
 
 */
4569
 
static void disas_fp_int_conv(DisasContext *s, uint32_t insn)
4570
 
{
4571
 
    int rd = extract32(insn, 0, 5);
4572
 
    int rn = extract32(insn, 5, 5);
4573
 
    int opcode = extract32(insn, 16, 3);
4574
 
    int rmode = extract32(insn, 19, 2);
4575
 
    int type = extract32(insn, 22, 2);
4576
 
    bool sbit = extract32(insn, 29, 1);
4577
 
    bool sf = extract32(insn, 31, 1);
4578
 
 
4579
 
    if (sbit) {
4580
 
        unallocated_encoding(s);
4581
 
        return;
4582
 
    }
4583
 
 
4584
 
    if (opcode > 5) {
4585
 
        /* FMOV */
4586
 
        bool itof = opcode & 1;
4587
 
 
4588
 
        if (rmode >= 2) {
4589
 
            unallocated_encoding(s);
4590
 
            return;
4591
 
        }
4592
 
 
4593
 
        switch (sf << 3 | type << 1 | rmode) {
4594
 
        case 0x0: /* 32 bit */
4595
 
        case 0xa: /* 64 bit */
4596
 
        case 0xd: /* 64 bit to top half of quad */
4597
 
            break;
4598
 
        default:
4599
 
            /* all other sf/type/rmode combinations are invalid */
4600
 
            unallocated_encoding(s);
4601
 
            break;
4602
 
        }
4603
 
 
4604
 
        handle_fmov(s, rd, rn, type, itof);
4605
 
    } else {
4606
 
        /* actual FP conversions */
4607
 
        bool itof = extract32(opcode, 1, 1);
4608
 
 
4609
 
        if (type > 1 || (rmode != 0 && opcode > 1)) {
4610
 
            unallocated_encoding(s);
4611
 
            return;
4612
 
        }
4613
 
 
4614
 
        handle_fpfpcvt(s, rd, rn, opcode, itof, rmode, 64, sf, type);
4615
 
    }
4616
 
}
4617
 
 
4618
 
/* FP-specific subcases of table C3-6 (SIMD and FP data processing)
4619
 
 *   31  30  29 28     25 24                          0
4620
 
 * +---+---+---+---------+-----------------------------+
4621
 
 * |   | 0 |   | 1 1 1 1 |                             |
4622
 
 * +---+---+---+---------+-----------------------------+
4623
 
 */
4624
 
static void disas_data_proc_fp(DisasContext *s, uint32_t insn)
4625
 
{
4626
 
    if (extract32(insn, 24, 1)) {
4627
 
        /* Floating point data-processing (3 source) */
4628
 
        disas_fp_3src(s, insn);
4629
 
    } else if (extract32(insn, 21, 1) == 0) {
4630
 
        /* Floating point to fixed point conversions */
4631
 
        disas_fp_fixed_conv(s, insn);
4632
 
    } else {
4633
 
        switch (extract32(insn, 10, 2)) {
4634
 
        case 1:
4635
 
            /* Floating point conditional compare */
4636
 
            disas_fp_ccomp(s, insn);
4637
 
            break;
4638
 
        case 2:
4639
 
            /* Floating point data-processing (2 source) */
4640
 
            disas_fp_2src(s, insn);
4641
 
            break;
4642
 
        case 3:
4643
 
            /* Floating point conditional select */
4644
 
            disas_fp_csel(s, insn);
4645
 
            break;
4646
 
        case 0:
4647
 
            switch (ctz32(extract32(insn, 12, 4))) {
4648
 
            case 0: /* [15:12] == xxx1 */
4649
 
                /* Floating point immediate */
4650
 
                disas_fp_imm(s, insn);
4651
 
                break;
4652
 
            case 1: /* [15:12] == xx10 */
4653
 
                /* Floating point compare */
4654
 
                disas_fp_compare(s, insn);
4655
 
                break;
4656
 
            case 2: /* [15:12] == x100 */
4657
 
                /* Floating point data-processing (1 source) */
4658
 
                disas_fp_1src(s, insn);
4659
 
                break;
4660
 
            case 3: /* [15:12] == 1000 */
4661
 
                unallocated_encoding(s);
4662
 
                break;
4663
 
            default: /* [15:12] == 0000 */
4664
 
                /* Floating point <-> integer conversions */
4665
 
                disas_fp_int_conv(s, insn);
4666
 
                break;
4667
 
            }
4668
 
            break;
4669
 
        }
4670
 
    }
4671
 
}
4672
 
 
4673
 
static void do_ext64(DisasContext *s, TCGv_i64 tcg_left, TCGv_i64 tcg_right,
4674
 
                     int pos)
4675
 
{
4676
 
    /* Extract 64 bits from the middle of two concatenated 64 bit
4677
 
     * vector register slices left:right. The extracted bits start
4678
 
     * at 'pos' bits into the right (least significant) side.
4679
 
     * We return the result in tcg_right, and guarantee not to
4680
 
     * trash tcg_left.
4681
 
     */
4682
 
    TCGv_i64 tcg_tmp = tcg_temp_new_i64();
4683
 
    assert(pos > 0 && pos < 64);
4684
 
 
4685
 
    tcg_gen_shri_i64(tcg_right, tcg_right, pos);
4686
 
    tcg_gen_shli_i64(tcg_tmp, tcg_left, 64 - pos);
4687
 
    tcg_gen_or_i64(tcg_right, tcg_right, tcg_tmp);
4688
 
 
4689
 
    tcg_temp_free_i64(tcg_tmp);
4690
 
}
4691
 
 
4692
 
/* C3.6.1 EXT
4693
 
 *   31  30 29         24 23 22  21 20  16 15  14  11 10  9    5 4    0
4694
 
 * +---+---+-------------+-----+---+------+---+------+---+------+------+
4695
 
 * | 0 | Q | 1 0 1 1 1 0 | op2 | 0 |  Rm  | 0 | imm4 | 0 |  Rn  |  Rd  |
4696
 
 * +---+---+-------------+-----+---+------+---+------+---+------+------+
4697
 
 */
4698
 
static void disas_simd_ext(DisasContext *s, uint32_t insn)
4699
 
{
4700
 
    int is_q = extract32(insn, 30, 1);
4701
 
    int op2 = extract32(insn, 22, 2);
4702
 
    int imm4 = extract32(insn, 11, 4);
4703
 
    int rm = extract32(insn, 16, 5);
4704
 
    int rn = extract32(insn, 5, 5);
4705
 
    int rd = extract32(insn, 0, 5);
4706
 
    int pos = imm4 << 3;
4707
 
    TCGv_i64 tcg_resl, tcg_resh;
4708
 
 
4709
 
    if (op2 != 0 || (!is_q && extract32(imm4, 3, 1))) {
4710
 
        unallocated_encoding(s);
4711
 
        return;
4712
 
    }
4713
 
 
4714
 
    tcg_resh = tcg_temp_new_i64();
4715
 
    tcg_resl = tcg_temp_new_i64();
4716
 
 
4717
 
    /* Vd gets bits starting at pos bits into Vm:Vn. This is
4718
 
     * either extracting 128 bits from a 128:128 concatenation, or
4719
 
     * extracting 64 bits from a 64:64 concatenation.
4720
 
     */
4721
 
    if (!is_q) {
4722
 
        read_vec_element(s, tcg_resl, rn, 0, MO_64);
4723
 
        if (pos != 0) {
4724
 
            read_vec_element(s, tcg_resh, rm, 0, MO_64);
4725
 
            do_ext64(s, tcg_resh, tcg_resl, pos);
4726
 
        }
4727
 
        tcg_gen_movi_i64(tcg_resh, 0);
4728
 
    } else {
4729
 
        TCGv_i64 tcg_hh;
4730
 
        typedef struct {
4731
 
            int reg;
4732
 
            int elt;
4733
 
        } EltPosns;
4734
 
        EltPosns eltposns[] = { {rn, 0}, {rn, 1}, {rm, 0}, {rm, 1} };
4735
 
        EltPosns *elt = eltposns;
4736
 
 
4737
 
        if (pos >= 64) {
4738
 
            elt++;
4739
 
            pos -= 64;
4740
 
        }
4741
 
 
4742
 
        read_vec_element(s, tcg_resl, elt->reg, elt->elt, MO_64);
4743
 
        elt++;
4744
 
        read_vec_element(s, tcg_resh, elt->reg, elt->elt, MO_64);
4745
 
        elt++;
4746
 
        if (pos != 0) {
4747
 
            do_ext64(s, tcg_resh, tcg_resl, pos);
4748
 
            tcg_hh = tcg_temp_new_i64();
4749
 
            read_vec_element(s, tcg_hh, elt->reg, elt->elt, MO_64);
4750
 
            do_ext64(s, tcg_hh, tcg_resh, pos);
4751
 
            tcg_temp_free_i64(tcg_hh);
4752
 
        }
4753
 
    }
4754
 
 
4755
 
    write_vec_element(s, tcg_resl, rd, 0, MO_64);
4756
 
    tcg_temp_free_i64(tcg_resl);
4757
 
    write_vec_element(s, tcg_resh, rd, 1, MO_64);
4758
 
    tcg_temp_free_i64(tcg_resh);
4759
 
}
4760
 
 
4761
 
/* C3.6.2 TBL/TBX
4762
 
 *   31  30 29         24 23 22  21 20  16 15  14 13  12  11 10 9    5 4    0
4763
 
 * +---+---+-------------+-----+---+------+---+-----+----+-----+------+------+
4764
 
 * | 0 | Q | 0 0 1 1 1 0 | op2 | 0 |  Rm  | 0 | len | op | 0 0 |  Rn  |  Rd  |
4765
 
 * +---+---+-------------+-----+---+------+---+-----+----+-----+------+------+
4766
 
 */
4767
 
static void disas_simd_tb(DisasContext *s, uint32_t insn)
4768
 
{
4769
 
    int op2 = extract32(insn, 22, 2);
4770
 
    int is_q = extract32(insn, 30, 1);
4771
 
    int rm = extract32(insn, 16, 5);
4772
 
    int rn = extract32(insn, 5, 5);
4773
 
    int rd = extract32(insn, 0, 5);
4774
 
    int is_tblx = extract32(insn, 12, 1);
4775
 
    int len = extract32(insn, 13, 2);
4776
 
    TCGv_i64 tcg_resl, tcg_resh, tcg_idx;
4777
 
    TCGv_i32 tcg_regno, tcg_numregs;
4778
 
 
4779
 
    if (op2 != 0) {
4780
 
        unallocated_encoding(s);
4781
 
        return;
4782
 
    }
4783
 
 
4784
 
    /* This does a table lookup: for every byte element in the input
4785
 
     * we index into a table formed from up to four vector registers,
4786
 
     * and then the output is the result of the lookups. Our helper
4787
 
     * function does the lookup operation for a single 64 bit part of
4788
 
     * the input.
4789
 
     */
4790
 
    tcg_resl = tcg_temp_new_i64();
4791
 
    tcg_resh = tcg_temp_new_i64();
4792
 
 
4793
 
    if (is_tblx) {
4794
 
        read_vec_element(s, tcg_resl, rd, 0, MO_64);
4795
 
    } else {
4796
 
        tcg_gen_movi_i64(tcg_resl, 0);
4797
 
    }
4798
 
    if (is_tblx && is_q) {
4799
 
        read_vec_element(s, tcg_resh, rd, 1, MO_64);
4800
 
    } else {
4801
 
        tcg_gen_movi_i64(tcg_resh, 0);
4802
 
    }
4803
 
 
4804
 
    tcg_idx = tcg_temp_new_i64();
4805
 
    tcg_regno = tcg_const_i32(rn);
4806
 
    tcg_numregs = tcg_const_i32(len + 1);
4807
 
    read_vec_element(s, tcg_idx, rm, 0, MO_64);
4808
 
    gen_helper_simd_tbl(tcg_resl, cpu_env, tcg_resl, tcg_idx,
4809
 
                        tcg_regno, tcg_numregs);
4810
 
    if (is_q) {
4811
 
        read_vec_element(s, tcg_idx, rm, 1, MO_64);
4812
 
        gen_helper_simd_tbl(tcg_resh, cpu_env, tcg_resh, tcg_idx,
4813
 
                            tcg_regno, tcg_numregs);
4814
 
    }
4815
 
    tcg_temp_free_i64(tcg_idx);
4816
 
    tcg_temp_free_i32(tcg_regno);
4817
 
    tcg_temp_free_i32(tcg_numregs);
4818
 
 
4819
 
    write_vec_element(s, tcg_resl, rd, 0, MO_64);
4820
 
    tcg_temp_free_i64(tcg_resl);
4821
 
    write_vec_element(s, tcg_resh, rd, 1, MO_64);
4822
 
    tcg_temp_free_i64(tcg_resh);
4823
 
}
4824
 
 
4825
 
/* C3.6.3 ZIP/UZP/TRN
4826
 
 *   31  30 29         24 23  22  21 20   16 15 14 12 11 10 9    5 4    0
4827
 
 * +---+---+-------------+------+---+------+---+------------------+------+
4828
 
 * | 0 | Q | 0 0 1 1 1 0 | size | 0 |  Rm  | 0 | opc | 1 0 |  Rn  |  Rd  |
4829
 
 * +---+---+-------------+------+---+------+---+------------------+------+
4830
 
 */
4831
 
static void disas_simd_zip_trn(DisasContext *s, uint32_t insn)
4832
 
{
4833
 
    int rd = extract32(insn, 0, 5);
4834
 
    int rn = extract32(insn, 5, 5);
4835
 
    int rm = extract32(insn, 16, 5);
4836
 
    int size = extract32(insn, 22, 2);
4837
 
    /* opc field bits [1:0] indicate ZIP/UZP/TRN;
4838
 
     * bit 2 indicates 1 vs 2 variant of the insn.
4839
 
     */
4840
 
    int opcode = extract32(insn, 12, 2);
4841
 
    bool part = extract32(insn, 14, 1);
4842
 
    bool is_q = extract32(insn, 30, 1);
4843
 
    int esize = 8 << size;
4844
 
    int i, ofs;
4845
 
    int datasize = is_q ? 128 : 64;
4846
 
    int elements = datasize / esize;
4847
 
    TCGv_i64 tcg_res, tcg_resl, tcg_resh;
4848
 
 
4849
 
    if (opcode == 0 || (size == 3 && !is_q)) {
4850
 
        unallocated_encoding(s);
4851
 
        return;
4852
 
    }
4853
 
 
4854
 
    tcg_resl = tcg_const_i64(0);
4855
 
    tcg_resh = tcg_const_i64(0);
4856
 
    tcg_res = tcg_temp_new_i64();
4857
 
 
4858
 
    for (i = 0; i < elements; i++) {
4859
 
        switch (opcode) {
4860
 
        case 1: /* UZP1/2 */
4861
 
        {
4862
 
            int midpoint = elements / 2;
4863
 
            if (i < midpoint) {
4864
 
                read_vec_element(s, tcg_res, rn, 2 * i + part, size);
4865
 
            } else {
4866
 
                read_vec_element(s, tcg_res, rm,
4867
 
                                 2 * (i - midpoint) + part, size);
4868
 
            }
4869
 
            break;
4870
 
        }
4871
 
        case 2: /* TRN1/2 */
4872
 
            if (i & 1) {
4873
 
                read_vec_element(s, tcg_res, rm, (i & ~1) + part, size);
4874
 
            } else {
4875
 
                read_vec_element(s, tcg_res, rn, (i & ~1) + part, size);
4876
 
            }
4877
 
            break;
4878
 
        case 3: /* ZIP1/2 */
4879
 
        {
4880
 
            int base = part * elements / 2;
4881
 
            if (i & 1) {
4882
 
                read_vec_element(s, tcg_res, rm, base + (i >> 1), size);
4883
 
            } else {
4884
 
                read_vec_element(s, tcg_res, rn, base + (i >> 1), size);
4885
 
            }
4886
 
            break;
4887
 
        }
4888
 
        default:
4889
 
            g_assert_not_reached();
4890
 
        }
4891
 
 
4892
 
        ofs = i * esize;
4893
 
        if (ofs < 64) {
4894
 
            tcg_gen_shli_i64(tcg_res, tcg_res, ofs);
4895
 
            tcg_gen_or_i64(tcg_resl, tcg_resl, tcg_res);
4896
 
        } else {
4897
 
            tcg_gen_shli_i64(tcg_res, tcg_res, ofs - 64);
4898
 
            tcg_gen_or_i64(tcg_resh, tcg_resh, tcg_res);
4899
 
        }
4900
 
    }
4901
 
 
4902
 
    tcg_temp_free_i64(tcg_res);
4903
 
 
4904
 
    write_vec_element(s, tcg_resl, rd, 0, MO_64);
4905
 
    tcg_temp_free_i64(tcg_resl);
4906
 
    write_vec_element(s, tcg_resh, rd, 1, MO_64);
4907
 
    tcg_temp_free_i64(tcg_resh);
4908
 
}
4909
 
 
4910
 
static void do_minmaxop(DisasContext *s, TCGv_i32 tcg_elt1, TCGv_i32 tcg_elt2,
4911
 
                        int opc, bool is_min, TCGv_ptr fpst)
4912
 
{
4913
 
    /* Helper function for disas_simd_across_lanes: do a single precision
4914
 
     * min/max operation on the specified two inputs,
4915
 
     * and return the result in tcg_elt1.
4916
 
     */
4917
 
    if (opc == 0xc) {
4918
 
        if (is_min) {
4919
 
            gen_helper_vfp_minnums(tcg_elt1, tcg_elt1, tcg_elt2, fpst);
4920
 
        } else {
4921
 
            gen_helper_vfp_maxnums(tcg_elt1, tcg_elt1, tcg_elt2, fpst);
4922
 
        }
4923
 
    } else {
4924
 
        assert(opc == 0xf);
4925
 
        if (is_min) {
4926
 
            gen_helper_vfp_mins(tcg_elt1, tcg_elt1, tcg_elt2, fpst);
4927
 
        } else {
4928
 
            gen_helper_vfp_maxs(tcg_elt1, tcg_elt1, tcg_elt2, fpst);
4929
 
        }
4930
 
    }
4931
 
}
4932
 
 
4933
 
/* C3.6.4 AdvSIMD across lanes
4934
 
 *   31  30  29 28       24 23  22 21       17 16    12 11 10 9    5 4    0
4935
 
 * +---+---+---+-----------+------+-----------+--------+-----+------+------+
4936
 
 * | 0 | Q | U | 0 1 1 1 0 | size | 1 1 0 0 0 | opcode | 1 0 |  Rn  |  Rd  |
4937
 
 * +---+---+---+-----------+------+-----------+--------+-----+------+------+
4938
 
 */
4939
 
static void disas_simd_across_lanes(DisasContext *s, uint32_t insn)
4940
 
{
4941
 
    int rd = extract32(insn, 0, 5);
4942
 
    int rn = extract32(insn, 5, 5);
4943
 
    int size = extract32(insn, 22, 2);
4944
 
    int opcode = extract32(insn, 12, 5);
4945
 
    bool is_q = extract32(insn, 30, 1);
4946
 
    bool is_u = extract32(insn, 29, 1);
4947
 
    bool is_fp = false;
4948
 
    bool is_min = false;
4949
 
    int esize;
4950
 
    int elements;
4951
 
    int i;
4952
 
    TCGv_i64 tcg_res, tcg_elt;
4953
 
 
4954
 
    switch (opcode) {
4955
 
    case 0x1b: /* ADDV */
4956
 
        if (is_u) {
4957
 
            unallocated_encoding(s);
4958
 
            return;
4959
 
        }
4960
 
        /* fall through */
4961
 
    case 0x3: /* SADDLV, UADDLV */
4962
 
    case 0xa: /* SMAXV, UMAXV */
4963
 
    case 0x1a: /* SMINV, UMINV */
4964
 
        if (size == 3 || (size == 2 && !is_q)) {
4965
 
            unallocated_encoding(s);
4966
 
            return;
4967
 
        }
4968
 
        break;
4969
 
    case 0xc: /* FMAXNMV, FMINNMV */
4970
 
    case 0xf: /* FMAXV, FMINV */
4971
 
        if (!is_u || !is_q || extract32(size, 0, 1)) {
4972
 
            unallocated_encoding(s);
4973
 
            return;
4974
 
        }
4975
 
        /* Bit 1 of size field encodes min vs max, and actual size is always
4976
 
         * 32 bits: adjust the size variable so following code can rely on it
4977
 
         */
4978
 
        is_min = extract32(size, 1, 1);
4979
 
        is_fp = true;
4980
 
        size = 2;
4981
 
        break;
4982
 
    default:
4983
 
        unallocated_encoding(s);
4984
 
        return;
4985
 
    }
4986
 
 
4987
 
    esize = 8 << size;
4988
 
    elements = (is_q ? 128 : 64) / esize;
4989
 
 
4990
 
    tcg_res = tcg_temp_new_i64();
4991
 
    tcg_elt = tcg_temp_new_i64();
4992
 
 
4993
 
    /* These instructions operate across all lanes of a vector
4994
 
     * to produce a single result. We can guarantee that a 64
4995
 
     * bit intermediate is sufficient:
4996
 
     *  + for [US]ADDLV the maximum element size is 32 bits, and
4997
 
     *    the result type is 64 bits
4998
 
     *  + for FMAX*V, FMIN*V, ADDV the intermediate type is the
4999
 
     *    same as the element size, which is 32 bits at most
5000
 
     * For the integer operations we can choose to work at 64
5001
 
     * or 32 bits and truncate at the end; for simplicity
5002
 
     * we use 64 bits always. The floating point
5003
 
     * ops do require 32 bit intermediates, though.
5004
 
     */
5005
 
    if (!is_fp) {
5006
 
        read_vec_element(s, tcg_res, rn, 0, size | (is_u ? 0 : MO_SIGN));
5007
 
 
5008
 
        for (i = 1; i < elements; i++) {
5009
 
            read_vec_element(s, tcg_elt, rn, i, size | (is_u ? 0 : MO_SIGN));
5010
 
 
5011
 
            switch (opcode) {
5012
 
            case 0x03: /* SADDLV / UADDLV */
5013
 
            case 0x1b: /* ADDV */
5014
 
                tcg_gen_add_i64(tcg_res, tcg_res, tcg_elt);
5015
 
                break;
5016
 
            case 0x0a: /* SMAXV / UMAXV */
5017
 
                tcg_gen_movcond_i64(is_u ? TCG_COND_GEU : TCG_COND_GE,
5018
 
                                    tcg_res,
5019
 
                                    tcg_res, tcg_elt, tcg_res, tcg_elt);
5020
 
                break;
5021
 
            case 0x1a: /* SMINV / UMINV */
5022
 
                tcg_gen_movcond_i64(is_u ? TCG_COND_LEU : TCG_COND_LE,
5023
 
                                    tcg_res,
5024
 
                                    tcg_res, tcg_elt, tcg_res, tcg_elt);
5025
 
                break;
5026
 
                break;
5027
 
            default:
5028
 
                g_assert_not_reached();
5029
 
            }
5030
 
 
5031
 
        }
5032
 
    } else {
5033
 
        /* Floating point ops which work on 32 bit (single) intermediates.
5034
 
         * Note that correct NaN propagation requires that we do these
5035
 
         * operations in exactly the order specified by the pseudocode.
5036
 
         */
5037
 
        TCGv_i32 tcg_elt1 = tcg_temp_new_i32();
5038
 
        TCGv_i32 tcg_elt2 = tcg_temp_new_i32();
5039
 
        TCGv_i32 tcg_elt3 = tcg_temp_new_i32();
5040
 
        TCGv_ptr fpst = get_fpstatus_ptr();
5041
 
 
5042
 
        assert(esize == 32);
5043
 
        assert(elements == 4);
5044
 
 
5045
 
        read_vec_element(s, tcg_elt, rn, 0, MO_32);
5046
 
        tcg_gen_trunc_i64_i32(tcg_elt1, tcg_elt);
5047
 
        read_vec_element(s, tcg_elt, rn, 1, MO_32);
5048
 
        tcg_gen_trunc_i64_i32(tcg_elt2, tcg_elt);
5049
 
 
5050
 
        do_minmaxop(s, tcg_elt1, tcg_elt2, opcode, is_min, fpst);
5051
 
 
5052
 
        read_vec_element(s, tcg_elt, rn, 2, MO_32);
5053
 
        tcg_gen_trunc_i64_i32(tcg_elt2, tcg_elt);
5054
 
        read_vec_element(s, tcg_elt, rn, 3, MO_32);
5055
 
        tcg_gen_trunc_i64_i32(tcg_elt3, tcg_elt);
5056
 
 
5057
 
        do_minmaxop(s, tcg_elt2, tcg_elt3, opcode, is_min, fpst);
5058
 
 
5059
 
        do_minmaxop(s, tcg_elt1, tcg_elt2, opcode, is_min, fpst);
5060
 
 
5061
 
        tcg_gen_extu_i32_i64(tcg_res, tcg_elt1);
5062
 
        tcg_temp_free_i32(tcg_elt1);
5063
 
        tcg_temp_free_i32(tcg_elt2);
5064
 
        tcg_temp_free_i32(tcg_elt3);
5065
 
        tcg_temp_free_ptr(fpst);
5066
 
    }
5067
 
 
5068
 
    tcg_temp_free_i64(tcg_elt);
5069
 
 
5070
 
    /* Now truncate the result to the width required for the final output */
5071
 
    if (opcode == 0x03) {
5072
 
        /* SADDLV, UADDLV: result is 2*esize */
5073
 
        size++;
5074
 
    }
5075
 
 
5076
 
    switch (size) {
5077
 
    case 0:
5078
 
        tcg_gen_ext8u_i64(tcg_res, tcg_res);
5079
 
        break;
5080
 
    case 1:
5081
 
        tcg_gen_ext16u_i64(tcg_res, tcg_res);
5082
 
        break;
5083
 
    case 2:
5084
 
        tcg_gen_ext32u_i64(tcg_res, tcg_res);
5085
 
        break;
5086
 
    case 3:
5087
 
        break;
5088
 
    default:
5089
 
        g_assert_not_reached();
5090
 
    }
5091
 
 
5092
 
    write_fp_dreg(s, rd, tcg_res);
5093
 
    tcg_temp_free_i64(tcg_res);
5094
 
}
5095
 
 
5096
 
/* C6.3.31 DUP (Element, Vector)
5097
 
 *
5098
 
 *  31  30   29              21 20    16 15        10  9    5 4    0
5099
 
 * +---+---+-------------------+--------+-------------+------+------+
5100
 
 * | 0 | Q | 0 0 1 1 1 0 0 0 0 |  imm5  | 0 0 0 0 0 1 |  Rn  |  Rd  |
5101
 
 * +---+---+-------------------+--------+-------------+------+------+
5102
 
 *
5103
 
 * size: encoded in imm5 (see ARM ARM LowestSetBit())
5104
 
 */
5105
 
static void handle_simd_dupe(DisasContext *s, int is_q, int rd, int rn,
5106
 
                             int imm5)
5107
 
{
5108
 
    int size = ctz32(imm5);
5109
 
    int esize = 8 << size;
5110
 
    int elements = (is_q ? 128 : 64) / esize;
5111
 
    int index, i;
5112
 
    TCGv_i64 tmp;
5113
 
 
5114
 
    if (size > 3 || (size == 3 && !is_q)) {
5115
 
        unallocated_encoding(s);
5116
 
        return;
5117
 
    }
5118
 
 
5119
 
    index = imm5 >> (size + 1);
5120
 
 
5121
 
    tmp = tcg_temp_new_i64();
5122
 
    read_vec_element(s, tmp, rn, index, size);
5123
 
 
5124
 
    for (i = 0; i < elements; i++) {
5125
 
        write_vec_element(s, tmp, rd, i, size);
5126
 
    }
5127
 
 
5128
 
    if (!is_q) {
5129
 
        clear_vec_high(s, rd);
5130
 
    }
5131
 
 
5132
 
    tcg_temp_free_i64(tmp);
5133
 
}
5134
 
 
5135
 
/* C6.3.31 DUP (element, scalar)
5136
 
 *  31                   21 20    16 15        10  9    5 4    0
5137
 
 * +-----------------------+--------+-------------+------+------+
5138
 
 * | 0 1 0 1 1 1 1 0 0 0 0 |  imm5  | 0 0 0 0 0 1 |  Rn  |  Rd  |
5139
 
 * +-----------------------+--------+-------------+------+------+
5140
 
 */
5141
 
static void handle_simd_dupes(DisasContext *s, int rd, int rn,
5142
 
                              int imm5)
5143
 
{
5144
 
    int size = ctz32(imm5);
5145
 
    int index;
5146
 
    TCGv_i64 tmp;
5147
 
 
5148
 
    if (size > 3) {
5149
 
        unallocated_encoding(s);
5150
 
        return;
5151
 
    }
5152
 
 
5153
 
    index = imm5 >> (size + 1);
5154
 
 
5155
 
    /* This instruction just extracts the specified element and
5156
 
     * zero-extends it into the bottom of the destination register.
5157
 
     */
5158
 
    tmp = tcg_temp_new_i64();
5159
 
    read_vec_element(s, tmp, rn, index, size);
5160
 
    write_fp_dreg(s, rd, tmp);
5161
 
    tcg_temp_free_i64(tmp);
5162
 
}
5163
 
 
5164
 
/* C6.3.32 DUP (General)
5165
 
 *
5166
 
 *  31  30   29              21 20    16 15        10  9    5 4    0
5167
 
 * +---+---+-------------------+--------+-------------+------+------+
5168
 
 * | 0 | Q | 0 0 1 1 1 0 0 0 0 |  imm5  | 0 0 0 0 1 1 |  Rn  |  Rd  |
5169
 
 * +---+---+-------------------+--------+-------------+------+------+
5170
 
 *
5171
 
 * size: encoded in imm5 (see ARM ARM LowestSetBit())
5172
 
 */
5173
 
static void handle_simd_dupg(DisasContext *s, int is_q, int rd, int rn,
5174
 
                             int imm5)
5175
 
{
5176
 
    int size = ctz32(imm5);
5177
 
    int esize = 8 << size;
5178
 
    int elements = (is_q ? 128 : 64)/esize;
5179
 
    int i = 0;
5180
 
 
5181
 
    if (size > 3 || ((size == 3) && !is_q)) {
5182
 
        unallocated_encoding(s);
5183
 
        return;
5184
 
    }
5185
 
    for (i = 0; i < elements; i++) {
5186
 
        write_vec_element(s, cpu_reg(s, rn), rd, i, size);
5187
 
    }
5188
 
    if (!is_q) {
5189
 
        clear_vec_high(s, rd);
5190
 
    }
5191
 
}
5192
 
 
5193
 
/* C6.3.150 INS (Element)
5194
 
 *
5195
 
 *  31                   21 20    16 15  14    11  10 9    5 4    0
5196
 
 * +-----------------------+--------+------------+---+------+------+
5197
 
 * | 0 1 1 0 1 1 1 0 0 0 0 |  imm5  | 0 |  imm4  | 1 |  Rn  |  Rd  |
5198
 
 * +-----------------------+--------+------------+---+------+------+
5199
 
 *
5200
 
 * size: encoded in imm5 (see ARM ARM LowestSetBit())
5201
 
 * index: encoded in imm5<4:size+1>
5202
 
 */
5203
 
static void handle_simd_inse(DisasContext *s, int rd, int rn,
5204
 
                             int imm4, int imm5)
5205
 
{
5206
 
    int size = ctz32(imm5);
5207
 
    int src_index, dst_index;
5208
 
    TCGv_i64 tmp;
5209
 
 
5210
 
    if (size > 3) {
5211
 
        unallocated_encoding(s);
5212
 
        return;
5213
 
    }
5214
 
    dst_index = extract32(imm5, 1+size, 5);
5215
 
    src_index = extract32(imm4, size, 4);
5216
 
 
5217
 
    tmp = tcg_temp_new_i64();
5218
 
 
5219
 
    read_vec_element(s, tmp, rn, src_index, size);
5220
 
    write_vec_element(s, tmp, rd, dst_index, size);
5221
 
 
5222
 
    tcg_temp_free_i64(tmp);
5223
 
}
5224
 
 
5225
 
 
5226
 
/* C6.3.151 INS (General)
5227
 
 *
5228
 
 *  31                   21 20    16 15        10  9    5 4    0
5229
 
 * +-----------------------+--------+-------------+------+------+
5230
 
 * | 0 1 0 0 1 1 1 0 0 0 0 |  imm5  | 0 0 0 1 1 1 |  Rn  |  Rd  |
5231
 
 * +-----------------------+--------+-------------+------+------+
5232
 
 *
5233
 
 * size: encoded in imm5 (see ARM ARM LowestSetBit())
5234
 
 * index: encoded in imm5<4:size+1>
5235
 
 */
5236
 
static void handle_simd_insg(DisasContext *s, int rd, int rn, int imm5)
5237
 
{
5238
 
    int size = ctz32(imm5);
5239
 
    int idx;
5240
 
 
5241
 
    if (size > 3) {
5242
 
        unallocated_encoding(s);
5243
 
        return;
5244
 
    }
5245
 
 
5246
 
    idx = extract32(imm5, 1 + size, 4 - size);
5247
 
    write_vec_element(s, cpu_reg(s, rn), rd, idx, size);
5248
 
}
5249
 
 
5250
 
/*
5251
 
 * C6.3.321 UMOV (General)
5252
 
 * C6.3.237 SMOV (General)
5253
 
 *
5254
 
 *  31  30   29              21 20    16 15    12   10 9    5 4    0
5255
 
 * +---+---+-------------------+--------+-------------+------+------+
5256
 
 * | 0 | Q | 0 0 1 1 1 0 0 0 0 |  imm5  | 0 0 1 U 1 1 |  Rn  |  Rd  |
5257
 
 * +---+---+-------------------+--------+-------------+------+------+
5258
 
 *
5259
 
 * U: unsigned when set
5260
 
 * size: encoded in imm5 (see ARM ARM LowestSetBit())
5261
 
 */
5262
 
static void handle_simd_umov_smov(DisasContext *s, int is_q, int is_signed,
5263
 
                                  int rn, int rd, int imm5)
5264
 
{
5265
 
    int size = ctz32(imm5);
5266
 
    int element;
5267
 
    TCGv_i64 tcg_rd;
5268
 
 
5269
 
    /* Check for UnallocatedEncodings */
5270
 
    if (is_signed) {
5271
 
        if (size > 2 || (size == 2 && !is_q)) {
5272
 
            unallocated_encoding(s);
5273
 
            return;
5274
 
        }
5275
 
    } else {
5276
 
        if (size > 3
5277
 
            || (size < 3 && is_q)
5278
 
            || (size == 3 && !is_q)) {
5279
 
            unallocated_encoding(s);
5280
 
            return;
5281
 
        }
5282
 
    }
5283
 
    element = extract32(imm5, 1+size, 4);
5284
 
 
5285
 
    tcg_rd = cpu_reg(s, rd);
5286
 
    read_vec_element(s, tcg_rd, rn, element, size | (is_signed ? MO_SIGN : 0));
5287
 
    if (is_signed && !is_q) {
5288
 
        tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
5289
 
    }
5290
 
}
5291
 
 
5292
 
/* C3.6.5 AdvSIMD copy
5293
 
 *   31  30  29  28             21 20  16 15  14  11 10  9    5 4    0
5294
 
 * +---+---+----+-----------------+------+---+------+---+------+------+
5295
 
 * | 0 | Q | op | 0 1 1 1 0 0 0 0 | imm5 | 0 | imm4 | 1 |  Rn  |  Rd  |
5296
 
 * +---+---+----+-----------------+------+---+------+---+------+------+
5297
 
 */
5298
 
static void disas_simd_copy(DisasContext *s, uint32_t insn)
5299
 
{
5300
 
    int rd = extract32(insn, 0, 5);
5301
 
    int rn = extract32(insn, 5, 5);
5302
 
    int imm4 = extract32(insn, 11, 4);
5303
 
    int op = extract32(insn, 29, 1);
5304
 
    int is_q = extract32(insn, 30, 1);
5305
 
    int imm5 = extract32(insn, 16, 5);
5306
 
 
5307
 
    if (op) {
5308
 
        if (is_q) {
5309
 
            /* INS (element) */
5310
 
            handle_simd_inse(s, rd, rn, imm4, imm5);
5311
 
        } else {
5312
 
            unallocated_encoding(s);
5313
 
        }
5314
 
    } else {
5315
 
        switch (imm4) {
5316
 
        case 0:
5317
 
            /* DUP (element - vector) */
5318
 
            handle_simd_dupe(s, is_q, rd, rn, imm5);
5319
 
            break;
5320
 
        case 1:
5321
 
            /* DUP (general) */
5322
 
            handle_simd_dupg(s, is_q, rd, rn, imm5);
5323
 
            break;
5324
 
        case 3:
5325
 
            if (is_q) {
5326
 
                /* INS (general) */
5327
 
                handle_simd_insg(s, rd, rn, imm5);
5328
 
            } else {
5329
 
                unallocated_encoding(s);
5330
 
            }
5331
 
            break;
5332
 
        case 5:
5333
 
        case 7:
5334
 
            /* UMOV/SMOV (is_q indicates 32/64; imm4 indicates signedness) */
5335
 
            handle_simd_umov_smov(s, is_q, (imm4 == 5), rn, rd, imm5);
5336
 
            break;
5337
 
        default:
5338
 
            unallocated_encoding(s);
5339
 
            break;
5340
 
        }
5341
 
    }
5342
 
}
5343
 
 
5344
 
/* C3.6.6 AdvSIMD modified immediate
5345
 
 *  31  30   29  28                 19 18 16 15   12  11  10  9     5 4    0
5346
 
 * +---+---+----+---------------------+-----+-------+----+---+-------+------+
5347
 
 * | 0 | Q | op | 0 1 1 1 1 0 0 0 0 0 | abc | cmode | o2 | 1 | defgh |  Rd  |
5348
 
 * +---+---+----+---------------------+-----+-------+----+---+-------+------+
5349
 
 *
5350
 
 * There are a number of operations that can be carried out here:
5351
 
 *   MOVI - move (shifted) imm into register
5352
 
 *   MVNI - move inverted (shifted) imm into register
5353
 
 *   ORR  - bitwise OR of (shifted) imm with register
5354
 
 *   BIC  - bitwise clear of (shifted) imm with register
5355
 
 */
5356
 
static void disas_simd_mod_imm(DisasContext *s, uint32_t insn)
5357
 
{
5358
 
    int rd = extract32(insn, 0, 5);
5359
 
    int cmode = extract32(insn, 12, 4);
5360
 
    int cmode_3_1 = extract32(cmode, 1, 3);
5361
 
    int cmode_0 = extract32(cmode, 0, 1);
5362
 
    int o2 = extract32(insn, 11, 1);
5363
 
    uint64_t abcdefgh = extract32(insn, 5, 5) | (extract32(insn, 16, 3) << 5);
5364
 
    bool is_neg = extract32(insn, 29, 1);
5365
 
    bool is_q = extract32(insn, 30, 1);
5366
 
    uint64_t imm = 0;
5367
 
    TCGv_i64 tcg_rd, tcg_imm;
5368
 
    int i;
5369
 
 
5370
 
    if (o2 != 0 || ((cmode == 0xf) && is_neg && !is_q)) {
5371
 
        unallocated_encoding(s);
5372
 
        return;
5373
 
    }
5374
 
 
5375
 
    /* See AdvSIMDExpandImm() in ARM ARM */
5376
 
    switch (cmode_3_1) {
5377
 
    case 0: /* Replicate(Zeros(24):imm8, 2) */
5378
 
    case 1: /* Replicate(Zeros(16):imm8:Zeros(8), 2) */
5379
 
    case 2: /* Replicate(Zeros(8):imm8:Zeros(16), 2) */
5380
 
    case 3: /* Replicate(imm8:Zeros(24), 2) */
5381
 
    {
5382
 
        int shift = cmode_3_1 * 8;
5383
 
        imm = bitfield_replicate(abcdefgh << shift, 32);
5384
 
        break;
5385
 
    }
5386
 
    case 4: /* Replicate(Zeros(8):imm8, 4) */
5387
 
    case 5: /* Replicate(imm8:Zeros(8), 4) */
5388
 
    {
5389
 
        int shift = (cmode_3_1 & 0x1) * 8;
5390
 
        imm = bitfield_replicate(abcdefgh << shift, 16);
5391
 
        break;
5392
 
    }
5393
 
    case 6:
5394
 
        if (cmode_0) {
5395
 
            /* Replicate(Zeros(8):imm8:Ones(16), 2) */
5396
 
            imm = (abcdefgh << 16) | 0xffff;
5397
 
        } else {
5398
 
            /* Replicate(Zeros(16):imm8:Ones(8), 2) */
5399
 
            imm = (abcdefgh << 8) | 0xff;
5400
 
        }
5401
 
        imm = bitfield_replicate(imm, 32);
5402
 
        break;
5403
 
    case 7:
5404
 
        if (!cmode_0 && !is_neg) {
5405
 
            imm = bitfield_replicate(abcdefgh, 8);
5406
 
        } else if (!cmode_0 && is_neg) {
5407
 
            int i;
5408
 
            imm = 0;
5409
 
            for (i = 0; i < 8; i++) {
5410
 
                if ((abcdefgh) & (1 << i)) {
5411
 
                    imm |= 0xffULL << (i * 8);
5412
 
                }
5413
 
            }
5414
 
        } else if (cmode_0) {
5415
 
            if (is_neg) {
5416
 
                imm = (abcdefgh & 0x3f) << 48;
5417
 
                if (abcdefgh & 0x80) {
5418
 
                    imm |= 0x8000000000000000ULL;
5419
 
                }
5420
 
                if (abcdefgh & 0x40) {
5421
 
                    imm |= 0x3fc0000000000000ULL;
5422
 
                } else {
5423
 
                    imm |= 0x4000000000000000ULL;
5424
 
                }
5425
 
            } else {
5426
 
                imm = (abcdefgh & 0x3f) << 19;
5427
 
                if (abcdefgh & 0x80) {
5428
 
                    imm |= 0x80000000;
5429
 
                }
5430
 
                if (abcdefgh & 0x40) {
5431
 
                    imm |= 0x3e000000;
5432
 
                } else {
5433
 
                    imm |= 0x40000000;
5434
 
                }
5435
 
                imm |= (imm << 32);
5436
 
            }
5437
 
        }
5438
 
        break;
5439
 
    }
5440
 
 
5441
 
    if (cmode_3_1 != 7 && is_neg) {
5442
 
        imm = ~imm;
5443
 
    }
5444
 
 
5445
 
    tcg_imm = tcg_const_i64(imm);
5446
 
    tcg_rd = new_tmp_a64(s);
5447
 
 
5448
 
    for (i = 0; i < 2; i++) {
5449
 
        int foffs = i ? fp_reg_hi_offset(rd) : fp_reg_offset(rd, MO_64);
5450
 
 
5451
 
        if (i == 1 && !is_q) {
5452
 
            /* non-quad ops clear high half of vector */
5453
 
            tcg_gen_movi_i64(tcg_rd, 0);
5454
 
        } else if ((cmode & 0x9) == 0x1 || (cmode & 0xd) == 0x9) {
5455
 
            tcg_gen_ld_i64(tcg_rd, cpu_env, foffs);
5456
 
            if (is_neg) {
5457
 
                /* AND (BIC) */
5458
 
                tcg_gen_and_i64(tcg_rd, tcg_rd, tcg_imm);
5459
 
            } else {
5460
 
                /* ORR */
5461
 
                tcg_gen_or_i64(tcg_rd, tcg_rd, tcg_imm);
5462
 
            }
5463
 
        } else {
5464
 
            /* MOVI */
5465
 
            tcg_gen_mov_i64(tcg_rd, tcg_imm);
5466
 
        }
5467
 
        tcg_gen_st_i64(tcg_rd, cpu_env, foffs);
5468
 
    }
5469
 
 
5470
 
    tcg_temp_free_i64(tcg_imm);
5471
 
}
5472
 
 
5473
 
/* C3.6.7 AdvSIMD scalar copy
5474
 
 *  31 30  29  28             21 20  16 15  14  11 10  9    5 4    0
5475
 
 * +-----+----+-----------------+------+---+------+---+------+------+
5476
 
 * | 0 1 | op | 1 1 1 1 0 0 0 0 | imm5 | 0 | imm4 | 1 |  Rn  |  Rd  |
5477
 
 * +-----+----+-----------------+------+---+------+---+------+------+
5478
 
 */
5479
 
static void disas_simd_scalar_copy(DisasContext *s, uint32_t insn)
5480
 
{
5481
 
    int rd = extract32(insn, 0, 5);
5482
 
    int rn = extract32(insn, 5, 5);
5483
 
    int imm4 = extract32(insn, 11, 4);
5484
 
    int imm5 = extract32(insn, 16, 5);
5485
 
    int op = extract32(insn, 29, 1);
5486
 
 
5487
 
    if (op != 0 || imm4 != 0) {
5488
 
        unallocated_encoding(s);
5489
 
        return;
5490
 
    }
5491
 
 
5492
 
    /* DUP (element, scalar) */
5493
 
    handle_simd_dupes(s, rd, rn, imm5);
5494
 
}
5495
 
 
5496
 
/* C3.6.8 AdvSIMD scalar pairwise
5497
 
 *  31 30  29 28       24 23  22 21       17 16    12 11 10 9    5 4    0
5498
 
 * +-----+---+-----------+------+-----------+--------+-----+------+------+
5499
 
 * | 0 1 | U | 1 1 1 1 0 | size | 1 1 0 0 0 | opcode | 1 0 |  Rn  |  Rd  |
5500
 
 * +-----+---+-----------+------+-----------+--------+-----+------+------+
5501
 
 */
5502
 
static void disas_simd_scalar_pairwise(DisasContext *s, uint32_t insn)
5503
 
{
5504
 
    int u = extract32(insn, 29, 1);
5505
 
    int size = extract32(insn, 22, 2);
5506
 
    int opcode = extract32(insn, 12, 5);
5507
 
    int rn = extract32(insn, 5, 5);
5508
 
    int rd = extract32(insn, 0, 5);
5509
 
    TCGv_ptr fpst;
5510
 
 
5511
 
    /* For some ops (the FP ones), size[1] is part of the encoding.
5512
 
     * For ADDP strictly it is not but size[1] is always 1 for valid
5513
 
     * encodings.
5514
 
     */
5515
 
    opcode |= (extract32(size, 1, 1) << 5);
5516
 
 
5517
 
    switch (opcode) {
5518
 
    case 0x3b: /* ADDP */
5519
 
        if (u || size != 3) {
5520
 
            unallocated_encoding(s);
5521
 
            return;
5522
 
        }
5523
 
        TCGV_UNUSED_PTR(fpst);
5524
 
        break;
5525
 
    case 0xc: /* FMAXNMP */
5526
 
    case 0xd: /* FADDP */
5527
 
    case 0xf: /* FMAXP */
5528
 
    case 0x2c: /* FMINNMP */
5529
 
    case 0x2f: /* FMINP */
5530
 
        /* FP op, size[0] is 32 or 64 bit */
5531
 
        if (!u) {
5532
 
            unallocated_encoding(s);
5533
 
            return;
5534
 
        }
5535
 
        size = extract32(size, 0, 1) ? 3 : 2;
5536
 
        fpst = get_fpstatus_ptr();
5537
 
        break;
5538
 
    default:
5539
 
        unallocated_encoding(s);
5540
 
        return;
5541
 
    }
5542
 
 
5543
 
    if (size == 3) {
5544
 
        TCGv_i64 tcg_op1 = tcg_temp_new_i64();
5545
 
        TCGv_i64 tcg_op2 = tcg_temp_new_i64();
5546
 
        TCGv_i64 tcg_res = tcg_temp_new_i64();
5547
 
 
5548
 
        read_vec_element(s, tcg_op1, rn, 0, MO_64);
5549
 
        read_vec_element(s, tcg_op2, rn, 1, MO_64);
5550
 
 
5551
 
        switch (opcode) {
5552
 
        case 0x3b: /* ADDP */
5553
 
            tcg_gen_add_i64(tcg_res, tcg_op1, tcg_op2);
5554
 
            break;
5555
 
        case 0xc: /* FMAXNMP */
5556
 
            gen_helper_vfp_maxnumd(tcg_res, tcg_op1, tcg_op2, fpst);
5557
 
            break;
5558
 
        case 0xd: /* FADDP */
5559
 
            gen_helper_vfp_addd(tcg_res, tcg_op1, tcg_op2, fpst);
5560
 
            break;
5561
 
        case 0xf: /* FMAXP */
5562
 
            gen_helper_vfp_maxd(tcg_res, tcg_op1, tcg_op2, fpst);
5563
 
            break;
5564
 
        case 0x2c: /* FMINNMP */
5565
 
            gen_helper_vfp_minnumd(tcg_res, tcg_op1, tcg_op2, fpst);
5566
 
            break;
5567
 
        case 0x2f: /* FMINP */
5568
 
            gen_helper_vfp_mind(tcg_res, tcg_op1, tcg_op2, fpst);
5569
 
            break;
5570
 
        default:
5571
 
            g_assert_not_reached();
5572
 
        }
5573
 
 
5574
 
        write_fp_dreg(s, rd, tcg_res);
5575
 
 
5576
 
        tcg_temp_free_i64(tcg_op1);
5577
 
        tcg_temp_free_i64(tcg_op2);
5578
 
        tcg_temp_free_i64(tcg_res);
5579
 
    } else {
5580
 
        TCGv_i32 tcg_op1 = tcg_temp_new_i32();
5581
 
        TCGv_i32 tcg_op2 = tcg_temp_new_i32();
5582
 
        TCGv_i32 tcg_res = tcg_temp_new_i32();
5583
 
 
5584
 
        read_vec_element_i32(s, tcg_op1, rn, 0, MO_32);
5585
 
        read_vec_element_i32(s, tcg_op2, rn, 1, MO_32);
5586
 
 
5587
 
        switch (opcode) {
5588
 
        case 0xc: /* FMAXNMP */
5589
 
            gen_helper_vfp_maxnums(tcg_res, tcg_op1, tcg_op2, fpst);
5590
 
            break;
5591
 
        case 0xd: /* FADDP */
5592
 
            gen_helper_vfp_adds(tcg_res, tcg_op1, tcg_op2, fpst);
5593
 
            break;
5594
 
        case 0xf: /* FMAXP */
5595
 
            gen_helper_vfp_maxs(tcg_res, tcg_op1, tcg_op2, fpst);
5596
 
            break;
5597
 
        case 0x2c: /* FMINNMP */
5598
 
            gen_helper_vfp_minnums(tcg_res, tcg_op1, tcg_op2, fpst);
5599
 
            break;
5600
 
        case 0x2f: /* FMINP */
5601
 
            gen_helper_vfp_mins(tcg_res, tcg_op1, tcg_op2, fpst);
5602
 
            break;
5603
 
        default:
5604
 
            g_assert_not_reached();
5605
 
        }
5606
 
 
5607
 
        write_fp_sreg(s, rd, tcg_res);
5608
 
 
5609
 
        tcg_temp_free_i32(tcg_op1);
5610
 
        tcg_temp_free_i32(tcg_op2);
5611
 
        tcg_temp_free_i32(tcg_res);
5612
 
    }
5613
 
 
5614
 
    if (!TCGV_IS_UNUSED_PTR(fpst)) {
5615
 
        tcg_temp_free_ptr(fpst);
5616
 
    }
5617
 
}
5618
 
 
5619
 
/*
5620
 
 * Common SSHR[RA]/USHR[RA] - Shift right (optional rounding/accumulate)
5621
 
 *
5622
 
 * This code is handles the common shifting code and is used by both
5623
 
 * the vector and scalar code.
5624
 
 */
5625
 
static void handle_shri_with_rndacc(TCGv_i64 tcg_res, TCGv_i64 tcg_src,
5626
 
                                    TCGv_i64 tcg_rnd, bool accumulate,
5627
 
                                    bool is_u, int size, int shift)
5628
 
{
5629
 
    bool extended_result = false;
5630
 
    bool round = !TCGV_IS_UNUSED_I64(tcg_rnd);
5631
 
    int ext_lshift = 0;
5632
 
    TCGv_i64 tcg_src_hi;
5633
 
 
5634
 
    if (round && size == 3) {
5635
 
        extended_result = true;
5636
 
        ext_lshift = 64 - shift;
5637
 
        tcg_src_hi = tcg_temp_new_i64();
5638
 
    } else if (shift == 64) {
5639
 
        if (!accumulate && is_u) {
5640
 
            /* result is zero */
5641
 
            tcg_gen_movi_i64(tcg_res, 0);
5642
 
            return;
5643
 
        }
5644
 
    }
5645
 
 
5646
 
    /* Deal with the rounding step */
5647
 
    if (round) {
5648
 
        if (extended_result) {
5649
 
            TCGv_i64 tcg_zero = tcg_const_i64(0);
5650
 
            if (!is_u) {
5651
 
                /* take care of sign extending tcg_res */
5652
 
                tcg_gen_sari_i64(tcg_src_hi, tcg_src, 63);
5653
 
                tcg_gen_add2_i64(tcg_src, tcg_src_hi,
5654
 
                                 tcg_src, tcg_src_hi,
5655
 
                                 tcg_rnd, tcg_zero);
5656
 
            } else {
5657
 
                tcg_gen_add2_i64(tcg_src, tcg_src_hi,
5658
 
                                 tcg_src, tcg_zero,
5659
 
                                 tcg_rnd, tcg_zero);
5660
 
            }
5661
 
            tcg_temp_free_i64(tcg_zero);
5662
 
        } else {
5663
 
            tcg_gen_add_i64(tcg_src, tcg_src, tcg_rnd);
5664
 
        }
5665
 
    }
5666
 
 
5667
 
    /* Now do the shift right */
5668
 
    if (round && extended_result) {
5669
 
        /* extended case, >64 bit precision required */
5670
 
        if (ext_lshift == 0) {
5671
 
            /* special case, only high bits matter */
5672
 
            tcg_gen_mov_i64(tcg_src, tcg_src_hi);
5673
 
        } else {
5674
 
            tcg_gen_shri_i64(tcg_src, tcg_src, shift);
5675
 
            tcg_gen_shli_i64(tcg_src_hi, tcg_src_hi, ext_lshift);
5676
 
            tcg_gen_or_i64(tcg_src, tcg_src, tcg_src_hi);
5677
 
        }
5678
 
    } else {
5679
 
        if (is_u) {
5680
 
            if (shift == 64) {
5681
 
                /* essentially shifting in 64 zeros */
5682
 
                tcg_gen_movi_i64(tcg_src, 0);
5683
 
            } else {
5684
 
                tcg_gen_shri_i64(tcg_src, tcg_src, shift);
5685
 
            }
5686
 
        } else {
5687
 
            if (shift == 64) {
5688
 
                /* effectively extending the sign-bit */
5689
 
                tcg_gen_sari_i64(tcg_src, tcg_src, 63);
5690
 
            } else {
5691
 
                tcg_gen_sari_i64(tcg_src, tcg_src, shift);
5692
 
            }
5693
 
        }
5694
 
    }
5695
 
 
5696
 
    if (accumulate) {
5697
 
        tcg_gen_add_i64(tcg_res, tcg_res, tcg_src);
5698
 
    } else {
5699
 
        tcg_gen_mov_i64(tcg_res, tcg_src);
5700
 
    }
5701
 
 
5702
 
    if (extended_result) {
5703
 
        tcg_temp_free_i64(tcg_src_hi);
5704
 
    }
5705
 
}
5706
 
 
5707
 
/* Common SHL/SLI - Shift left with an optional insert */
5708
 
static void handle_shli_with_ins(TCGv_i64 tcg_res, TCGv_i64 tcg_src,
5709
 
                                 bool insert, int shift)
5710
 
{
5711
 
    if (insert) { /* SLI */
5712
 
        tcg_gen_deposit_i64(tcg_res, tcg_res, tcg_src, shift, 64 - shift);
5713
 
    } else { /* SHL */
5714
 
        tcg_gen_shli_i64(tcg_res, tcg_src, shift);
5715
 
    }
5716
 
}
5717
 
 
5718
 
/* SSHR[RA]/USHR[RA] - Scalar shift right (optional rounding/accumulate) */
5719
 
static void handle_scalar_simd_shri(DisasContext *s,
5720
 
                                    bool is_u, int immh, int immb,
5721
 
                                    int opcode, int rn, int rd)
5722
 
{
5723
 
    const int size = 3;
5724
 
    int immhb = immh << 3 | immb;
5725
 
    int shift = 2 * (8 << size) - immhb;
5726
 
    bool accumulate = false;
5727
 
    bool round = false;
5728
 
    TCGv_i64 tcg_rn;
5729
 
    TCGv_i64 tcg_rd;
5730
 
    TCGv_i64 tcg_round;
5731
 
 
5732
 
    if (!extract32(immh, 3, 1)) {
5733
 
        unallocated_encoding(s);
5734
 
        return;
5735
 
    }
5736
 
 
5737
 
    switch (opcode) {
5738
 
    case 0x02: /* SSRA / USRA (accumulate) */
5739
 
        accumulate = true;
5740
 
        break;
5741
 
    case 0x04: /* SRSHR / URSHR (rounding) */
5742
 
        round = true;
5743
 
        break;
5744
 
    case 0x06: /* SRSRA / URSRA (accum + rounding) */
5745
 
        accumulate = round = true;
5746
 
        break;
5747
 
    }
5748
 
 
5749
 
    if (round) {
5750
 
        uint64_t round_const = 1ULL << (shift - 1);
5751
 
        tcg_round = tcg_const_i64(round_const);
5752
 
    } else {
5753
 
        TCGV_UNUSED_I64(tcg_round);
5754
 
    }
5755
 
 
5756
 
    tcg_rn = read_fp_dreg(s, rn);
5757
 
    tcg_rd = accumulate ? read_fp_dreg(s, rd) : tcg_temp_new_i64();
5758
 
 
5759
 
    handle_shri_with_rndacc(tcg_rd, tcg_rn, tcg_round,
5760
 
                               accumulate, is_u, size, shift);
5761
 
 
5762
 
    write_fp_dreg(s, rd, tcg_rd);
5763
 
 
5764
 
    tcg_temp_free_i64(tcg_rn);
5765
 
    tcg_temp_free_i64(tcg_rd);
5766
 
    if (round) {
5767
 
        tcg_temp_free_i64(tcg_round);
5768
 
    }
5769
 
}
5770
 
 
5771
 
/* SHL/SLI - Scalar shift left */
5772
 
static void handle_scalar_simd_shli(DisasContext *s, bool insert,
5773
 
                                    int immh, int immb, int opcode,
5774
 
                                    int rn, int rd)
5775
 
{
5776
 
    int size = 32 - clz32(immh) - 1;
5777
 
    int immhb = immh << 3 | immb;
5778
 
    int shift = immhb - (8 << size);
5779
 
    TCGv_i64 tcg_rn = new_tmp_a64(s);
5780
 
    TCGv_i64 tcg_rd = new_tmp_a64(s);
5781
 
 
5782
 
    if (!extract32(immh, 3, 1)) {
5783
 
        unallocated_encoding(s);
5784
 
        return;
5785
 
    }
5786
 
 
5787
 
    tcg_rn = read_fp_dreg(s, rn);
5788
 
    tcg_rd = insert ? read_fp_dreg(s, rd) : tcg_temp_new_i64();
5789
 
 
5790
 
    handle_shli_with_ins(tcg_rd, tcg_rn, insert, shift);
5791
 
 
5792
 
    write_fp_dreg(s, rd, tcg_rd);
5793
 
 
5794
 
    tcg_temp_free_i64(tcg_rn);
5795
 
    tcg_temp_free_i64(tcg_rd);
5796
 
}
5797
 
 
5798
 
/* C3.6.9 AdvSIMD scalar shift by immediate
5799
 
 *  31 30  29 28         23 22  19 18  16 15    11  10 9    5 4    0
5800
 
 * +-----+---+-------------+------+------+--------+---+------+------+
5801
 
 * | 0 1 | U | 1 1 1 1 1 0 | immh | immb | opcode | 1 |  Rn  |  Rd  |
5802
 
 * +-----+---+-------------+------+------+--------+---+------+------+
5803
 
 *
5804
 
 * This is the scalar version so it works on a fixed sized registers
5805
 
 */
5806
 
static void disas_simd_scalar_shift_imm(DisasContext *s, uint32_t insn)
5807
 
{
5808
 
    int rd = extract32(insn, 0, 5);
5809
 
    int rn = extract32(insn, 5, 5);
5810
 
    int opcode = extract32(insn, 11, 5);
5811
 
    int immb = extract32(insn, 16, 3);
5812
 
    int immh = extract32(insn, 19, 4);
5813
 
    bool is_u = extract32(insn, 29, 1);
5814
 
 
5815
 
    switch (opcode) {
5816
 
    case 0x00: /* SSHR / USHR */
5817
 
    case 0x02: /* SSRA / USRA */
5818
 
    case 0x04: /* SRSHR / URSHR */
5819
 
    case 0x06: /* SRSRA / URSRA */
5820
 
        handle_scalar_simd_shri(s, is_u, immh, immb, opcode, rn, rd);
5821
 
        break;
5822
 
    case 0x0a: /* SHL / SLI */
5823
 
        handle_scalar_simd_shli(s, is_u, immh, immb, opcode, rn, rd);
5824
 
        break;
5825
 
    default:
5826
 
        unsupported_encoding(s, insn);
5827
 
        break;
5828
 
    }
5829
 
}
5830
 
 
5831
 
/* C3.6.10 AdvSIMD scalar three different
5832
 
 *  31 30  29 28       24 23  22  21 20  16 15    12 11 10 9    5 4    0
5833
 
 * +-----+---+-----------+------+---+------+--------+-----+------+------+
5834
 
 * | 0 1 | U | 1 1 1 1 0 | size | 1 |  Rm  | opcode | 0 0 |  Rn  |  Rd  |
5835
 
 * +-----+---+-----------+------+---+------+--------+-----+------+------+
5836
 
 */
5837
 
static void disas_simd_scalar_three_reg_diff(DisasContext *s, uint32_t insn)
5838
 
{
5839
 
    unsupported_encoding(s, insn);
5840
 
}
5841
 
 
5842
 
static void handle_3same_64(DisasContext *s, int opcode, bool u,
5843
 
                            TCGv_i64 tcg_rd, TCGv_i64 tcg_rn, TCGv_i64 tcg_rm)
5844
 
{
5845
 
    /* Handle 64x64->64 opcodes which are shared between the scalar
5846
 
     * and vector 3-same groups. We cover every opcode where size == 3
5847
 
     * is valid in either the three-reg-same (integer, not pairwise)
5848
 
     * or scalar-three-reg-same groups. (Some opcodes are not yet
5849
 
     * implemented.)
5850
 
     */
5851
 
    TCGCond cond;
5852
 
 
5853
 
    switch (opcode) {
5854
 
    case 0x1: /* SQADD */
5855
 
        if (u) {
5856
 
            gen_helper_neon_qadd_u64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5857
 
        } else {
5858
 
            gen_helper_neon_qadd_s64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5859
 
        }
5860
 
        break;
5861
 
    case 0x5: /* SQSUB */
5862
 
        if (u) {
5863
 
            gen_helper_neon_qsub_u64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5864
 
        } else {
5865
 
            gen_helper_neon_qsub_s64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5866
 
        }
5867
 
        break;
5868
 
    case 0x6: /* CMGT, CMHI */
5869
 
        /* 64 bit integer comparison, result = test ? (2^64 - 1) : 0.
5870
 
         * We implement this using setcond (test) and then negating.
5871
 
         */
5872
 
        cond = u ? TCG_COND_GTU : TCG_COND_GT;
5873
 
    do_cmop:
5874
 
        tcg_gen_setcond_i64(cond, tcg_rd, tcg_rn, tcg_rm);
5875
 
        tcg_gen_neg_i64(tcg_rd, tcg_rd);
5876
 
        break;
5877
 
    case 0x7: /* CMGE, CMHS */
5878
 
        cond = u ? TCG_COND_GEU : TCG_COND_GE;
5879
 
        goto do_cmop;
5880
 
    case 0x11: /* CMTST, CMEQ */
5881
 
        if (u) {
5882
 
            cond = TCG_COND_EQ;
5883
 
            goto do_cmop;
5884
 
        }
5885
 
        /* CMTST : test is "if (X & Y != 0)". */
5886
 
        tcg_gen_and_i64(tcg_rd, tcg_rn, tcg_rm);
5887
 
        tcg_gen_setcondi_i64(TCG_COND_NE, tcg_rd, tcg_rd, 0);
5888
 
        tcg_gen_neg_i64(tcg_rd, tcg_rd);
5889
 
        break;
5890
 
    case 0x8: /* SSHL, USHL */
5891
 
        if (u) {
5892
 
            gen_helper_neon_shl_u64(tcg_rd, tcg_rn, tcg_rm);
5893
 
        } else {
5894
 
            gen_helper_neon_shl_s64(tcg_rd, tcg_rn, tcg_rm);
5895
 
        }
5896
 
        break;
5897
 
    case 0x9: /* SQSHL, UQSHL */
5898
 
        if (u) {
5899
 
            gen_helper_neon_qshl_u64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5900
 
        } else {
5901
 
            gen_helper_neon_qshl_s64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5902
 
        }
5903
 
        break;
5904
 
    case 0xa: /* SRSHL, URSHL */
5905
 
        if (u) {
5906
 
            gen_helper_neon_rshl_u64(tcg_rd, tcg_rn, tcg_rm);
5907
 
        } else {
5908
 
            gen_helper_neon_rshl_s64(tcg_rd, tcg_rn, tcg_rm);
5909
 
        }
5910
 
        break;
5911
 
    case 0xb: /* SQRSHL, UQRSHL */
5912
 
        if (u) {
5913
 
            gen_helper_neon_qrshl_u64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5914
 
        } else {
5915
 
            gen_helper_neon_qrshl_s64(tcg_rd, cpu_env, tcg_rn, tcg_rm);
5916
 
        }
5917
 
        break;
5918
 
    case 0x10: /* ADD, SUB */
5919
 
        if (u) {
5920
 
            tcg_gen_sub_i64(tcg_rd, tcg_rn, tcg_rm);
5921
 
        } else {
5922
 
            tcg_gen_add_i64(tcg_rd, tcg_rn, tcg_rm);
5923
 
        }
5924
 
        break;
5925
 
    default:
5926
 
        g_assert_not_reached();
5927
 
    }
5928
 
}
5929
 
 
5930
 
/* Handle the 3-same-operands float operations; shared by the scalar
5931
 
 * and vector encodings. The caller must filter out any encodings
5932
 
 * not allocated for the encoding it is dealing with.
5933
 
 */
5934
 
static void handle_3same_float(DisasContext *s, int size, int elements,
5935
 
                               int fpopcode, int rd, int rn, int rm)
5936
 
{
5937
 
    int pass;
5938
 
    TCGv_ptr fpst = get_fpstatus_ptr();
5939
 
 
5940
 
    for (pass = 0; pass < elements; pass++) {
5941
 
        if (size) {
5942
 
            /* Double */
5943
 
            TCGv_i64 tcg_op1 = tcg_temp_new_i64();
5944
 
            TCGv_i64 tcg_op2 = tcg_temp_new_i64();
5945
 
            TCGv_i64 tcg_res = tcg_temp_new_i64();
5946
 
 
5947
 
            read_vec_element(s, tcg_op1, rn, pass, MO_64);
5948
 
            read_vec_element(s, tcg_op2, rm, pass, MO_64);
5949
 
 
5950
 
            switch (fpopcode) {
5951
 
            case 0x18: /* FMAXNM */
5952
 
                gen_helper_vfp_maxnumd(tcg_res, tcg_op1, tcg_op2, fpst);
5953
 
                break;
5954
 
            case 0x1a: /* FADD */
5955
 
                gen_helper_vfp_addd(tcg_res, tcg_op1, tcg_op2, fpst);
5956
 
                break;
5957
 
            case 0x1e: /* FMAX */
5958
 
                gen_helper_vfp_maxd(tcg_res, tcg_op1, tcg_op2, fpst);
5959
 
                break;
5960
 
            case 0x38: /* FMINNM */
5961
 
                gen_helper_vfp_minnumd(tcg_res, tcg_op1, tcg_op2, fpst);
5962
 
                break;
5963
 
            case 0x3a: /* FSUB */
5964
 
                gen_helper_vfp_subd(tcg_res, tcg_op1, tcg_op2, fpst);
5965
 
                break;
5966
 
            case 0x3e: /* FMIN */
5967
 
                gen_helper_vfp_mind(tcg_res, tcg_op1, tcg_op2, fpst);
5968
 
                break;
5969
 
            case 0x5b: /* FMUL */
5970
 
                gen_helper_vfp_muld(tcg_res, tcg_op1, tcg_op2, fpst);
5971
 
                break;
5972
 
            case 0x5f: /* FDIV */
5973
 
                gen_helper_vfp_divd(tcg_res, tcg_op1, tcg_op2, fpst);
5974
 
                break;
5975
 
            case 0x7a: /* FABD */
5976
 
                gen_helper_vfp_subd(tcg_res, tcg_op1, tcg_op2, fpst);
5977
 
                gen_helper_vfp_absd(tcg_res, tcg_res);
5978
 
                break;
5979
 
            default:
5980
 
                g_assert_not_reached();
5981
 
            }
5982
 
 
5983
 
            write_vec_element(s, tcg_res, rd, pass, MO_64);
5984
 
 
5985
 
            tcg_temp_free_i64(tcg_res);
5986
 
            tcg_temp_free_i64(tcg_op1);
5987
 
            tcg_temp_free_i64(tcg_op2);
5988
 
        } else {
5989
 
            /* Single */
5990
 
            TCGv_i32 tcg_op1 = tcg_temp_new_i32();
5991
 
            TCGv_i32 tcg_op2 = tcg_temp_new_i32();
5992
 
            TCGv_i32 tcg_res = tcg_temp_new_i32();
5993
 
 
5994
 
            read_vec_element_i32(s, tcg_op1, rn, pass, MO_32);
5995
 
            read_vec_element_i32(s, tcg_op2, rm, pass, MO_32);
5996
 
 
5997
 
            switch (fpopcode) {
5998
 
            case 0x1a: /* FADD */
5999
 
                gen_helper_vfp_adds(tcg_res, tcg_op1, tcg_op2, fpst);
6000
 
                break;
6001
 
            case 0x1e: /* FMAX */
6002
 
                gen_helper_vfp_maxs(tcg_res, tcg_op1, tcg_op2, fpst);
6003
 
                break;
6004
 
            case 0x18: /* FMAXNM */
6005
 
                gen_helper_vfp_maxnums(tcg_res, tcg_op1, tcg_op2, fpst);
6006
 
                break;
6007
 
            case 0x38: /* FMINNM */
6008
 
                gen_helper_vfp_minnums(tcg_res, tcg_op1, tcg_op2, fpst);
6009
 
                break;
6010
 
            case 0x3a: /* FSUB */
6011
 
                gen_helper_vfp_subs(tcg_res, tcg_op1, tcg_op2, fpst);
6012
 
                break;
6013
 
            case 0x3e: /* FMIN */
6014
 
                gen_helper_vfp_mins(tcg_res, tcg_op1, tcg_op2, fpst);
6015
 
                break;
6016
 
            case 0x5b: /* FMUL */
6017
 
                gen_helper_vfp_muls(tcg_res, tcg_op1, tcg_op2, fpst);
6018
 
                break;
6019
 
            case 0x5f: /* FDIV */
6020
 
                gen_helper_vfp_divs(tcg_res, tcg_op1, tcg_op2, fpst);
6021
 
                break;
6022
 
            case 0x7a: /* FABD */
6023
 
                gen_helper_vfp_subs(tcg_res, tcg_op1, tcg_op2, fpst);
6024
 
                gen_helper_vfp_abss(tcg_res, tcg_res);
6025
 
                break;
6026
 
            default:
6027
 
                g_assert_not_reached();
6028
 
            }
6029
 
 
6030
 
            if (elements == 1) {
6031
 
                /* scalar single so clear high part */
6032
 
                TCGv_i64 tcg_tmp = tcg_temp_new_i64();
6033
 
 
6034
 
                tcg_gen_extu_i32_i64(tcg_tmp, tcg_res);
6035
 
                write_vec_element(s, tcg_tmp, rd, pass, MO_64);
6036
 
                tcg_temp_free_i64(tcg_tmp);
6037
 
            } else {
6038
 
                write_vec_element_i32(s, tcg_res, rd, pass, MO_32);
6039
 
            }
6040
 
 
6041
 
            tcg_temp_free_i32(tcg_res);
6042
 
            tcg_temp_free_i32(tcg_op1);
6043
 
            tcg_temp_free_i32(tcg_op2);
6044
 
        }
6045
 
    }
6046
 
 
6047
 
    tcg_temp_free_ptr(fpst);
6048
 
 
6049
 
    if ((elements << size) < 4) {
6050
 
        /* scalar, or non-quad vector op */
6051
 
        clear_vec_high(s, rd);
6052
 
    }
6053
 
}
6054
 
 
6055
 
/* C3.6.11 AdvSIMD scalar three same
6056
 
 *  31 30  29 28       24 23  22  21 20  16 15    11  10 9    5 4    0
6057
 
 * +-----+---+-----------+------+---+------+--------+---+------+------+
6058
 
 * | 0 1 | U | 1 1 1 1 0 | size | 1 |  Rm  | opcode | 1 |  Rn  |  Rd  |
6059
 
 * +-----+---+-----------+------+---+------+--------+---+------+------+
6060
 
 */
6061
 
static void disas_simd_scalar_three_reg_same(DisasContext *s, uint32_t insn)
6062
 
{
6063
 
    int rd = extract32(insn, 0, 5);
6064
 
    int rn = extract32(insn, 5, 5);
6065
 
    int opcode = extract32(insn, 11, 5);
6066
 
    int rm = extract32(insn, 16, 5);
6067
 
    int size = extract32(insn, 22, 2);
6068
 
    bool u = extract32(insn, 29, 1);
6069
 
    TCGv_i64 tcg_rd;
6070
 
 
6071
 
    if (opcode >= 0x18) {
6072
 
        /* Floating point: U, size[1] and opcode indicate operation */
6073
 
        int fpopcode = opcode | (extract32(size, 1, 1) << 5) | (u << 6);
6074
 
        switch (fpopcode) {
6075
 
        case 0x1b: /* FMULX */
6076
 
        case 0x1c: /* FCMEQ */
6077
 
        case 0x1f: /* FRECPS */
6078
 
        case 0x3f: /* FRSQRTS */
6079
 
        case 0x5c: /* FCMGE */
6080
 
        case 0x5d: /* FACGE */
6081
 
        case 0x7c: /* FCMGT */
6082
 
        case 0x7d: /* FACGT */
6083
 
            unsupported_encoding(s, insn);
6084
 
            return;
6085
 
        case 0x7a: /* FABD */
6086
 
            break;
6087
 
        default:
6088
 
            unallocated_encoding(s);
6089
 
            return;
6090
 
        }
6091
 
 
6092
 
        handle_3same_float(s, extract32(size, 0, 1), 1, fpopcode, rd, rn, rm);
6093
 
        return;
6094
 
    }
6095
 
 
6096
 
    switch (opcode) {
6097
 
    case 0x1: /* SQADD, UQADD */
6098
 
    case 0x5: /* SQSUB, UQSUB */
6099
 
    case 0x9: /* SQSHL, UQSHL */
6100
 
    case 0xb: /* SQRSHL, UQRSHL */
6101
 
        break;
6102
 
    case 0x8: /* SSHL, USHL */
6103
 
    case 0xa: /* SRSHL, URSHL */
6104
 
    case 0x6: /* CMGT, CMHI */
6105
 
    case 0x7: /* CMGE, CMHS */
6106
 
    case 0x11: /* CMTST, CMEQ */
6107
 
    case 0x10: /* ADD, SUB (vector) */
6108
 
        if (size != 3) {
6109
 
            unallocated_encoding(s);
6110
 
            return;
6111
 
        }
6112
 
        break;
6113
 
    case 0x16: /* SQDMULH, SQRDMULH (vector) */
6114
 
        if (size != 1 && size != 2) {
6115
 
            unallocated_encoding(s);
6116
 
            return;
6117
 
        }
6118
 
        break;
6119
 
    default:
6120
 
        unallocated_encoding(s);
6121
 
        return;
6122
 
    }
6123
 
 
6124
 
    tcg_rd = tcg_temp_new_i64();
6125
 
 
6126
 
    if (size == 3) {
6127
 
        TCGv_i64 tcg_rn = read_fp_dreg(s, rn);
6128
 
        TCGv_i64 tcg_rm = read_fp_dreg(s, rm);
6129
 
 
6130
 
        handle_3same_64(s, opcode, u, tcg_rd, tcg_rn, tcg_rm);
6131
 
        tcg_temp_free_i64(tcg_rn);
6132
 
        tcg_temp_free_i64(tcg_rm);
6133
 
    } else {
6134
 
        /* Do a single operation on the lowest element in the vector.
6135
 
         * We use the standard Neon helpers and rely on 0 OP 0 == 0 with
6136
 
         * no side effects for all these operations.
6137
 
         * OPTME: special-purpose helpers would avoid doing some
6138
 
         * unnecessary work in the helper for the 8 and 16 bit cases.
6139
 
         */
6140
 
        NeonGenTwoOpEnvFn *genenvfn;
6141
 
        TCGv_i32 tcg_rn = tcg_temp_new_i32();
6142
 
        TCGv_i32 tcg_rm = tcg_temp_new_i32();
6143
 
        TCGv_i32 tcg_rd32 = tcg_temp_new_i32();
6144
 
 
6145
 
        read_vec_element_i32(s, tcg_rn, rn, 0, size);
6146
 
        read_vec_element_i32(s, tcg_rm, rm, 0, size);
6147
 
 
6148
 
        switch (opcode) {
6149
 
        case 0x1: /* SQADD, UQADD */
6150
 
        {
6151
 
            static NeonGenTwoOpEnvFn * const fns[3][2] = {
6152
 
                { gen_helper_neon_qadd_s8, gen_helper_neon_qadd_u8 },
6153
 
                { gen_helper_neon_qadd_s16, gen_helper_neon_qadd_u16 },
6154
 
                { gen_helper_neon_qadd_s32, gen_helper_neon_qadd_u32 },
6155
 
            };
6156
 
            genenvfn = fns[size][u];
6157
 
            break;
6158
 
        }
6159
 
        case 0x5: /* SQSUB, UQSUB */
6160
 
        {
6161
 
            static NeonGenTwoOpEnvFn * const fns[3][2] = {
6162
 
                { gen_helper_neon_qsub_s8, gen_helper_neon_qsub_u8 },
6163
 
                { gen_helper_neon_qsub_s16, gen_helper_neon_qsub_u16 },
6164
 
                { gen_helper_neon_qsub_s32, gen_helper_neon_qsub_u32 },
6165
 
            };
6166
 
            genenvfn = fns[size][u];
6167
 
            break;
6168
 
        }
6169
 
        case 0x9: /* SQSHL, UQSHL */
6170
 
        {
6171
 
            static NeonGenTwoOpEnvFn * const fns[3][2] = {
6172
 
                { gen_helper_neon_qshl_s8, gen_helper_neon_qshl_u8 },
6173
 
                { gen_helper_neon_qshl_s16, gen_helper_neon_qshl_u16 },
6174
 
                { gen_helper_neon_qshl_s32, gen_helper_neon_qshl_u32 },
6175
 
            };
6176
 
            genenvfn = fns[size][u];
6177
 
            break;
6178
 
        }
6179
 
        case 0xb: /* SQRSHL, UQRSHL */
6180
 
        {
6181
 
            static NeonGenTwoOpEnvFn * const fns[3][2] = {
6182
 
                { gen_helper_neon_qrshl_s8, gen_helper_neon_qrshl_u8 },
6183
 
                { gen_helper_neon_qrshl_s16, gen_helper_neon_qrshl_u16 },
6184
 
                { gen_helper_neon_qrshl_s32, gen_helper_neon_qrshl_u32 },
6185
 
            };
6186
 
            genenvfn = fns[size][u];
6187
 
            break;
6188
 
        }
6189
 
        case 0x16: /* SQDMULH, SQRDMULH */
6190
 
        {
6191
 
            static NeonGenTwoOpEnvFn * const fns[2][2] = {
6192
 
                { gen_helper_neon_qdmulh_s16, gen_helper_neon_qrdmulh_s16 },
6193
 
                { gen_helper_neon_qdmulh_s32, gen_helper_neon_qrdmulh_s32 },
6194
 
            };
6195
 
            assert(size == 1 || size == 2);
6196
 
            genenvfn = fns[size - 1][u];
6197
 
            break;
6198
 
        }
6199
 
        default:
6200
 
            g_assert_not_reached();
6201
 
        }
6202
 
 
6203
 
        genenvfn(tcg_rd32, cpu_env, tcg_rn, tcg_rm);
6204
 
        tcg_gen_extu_i32_i64(tcg_rd, tcg_rd32);
6205
 
        tcg_temp_free_i32(tcg_rd32);
6206
 
        tcg_temp_free_i32(tcg_rn);
6207
 
        tcg_temp_free_i32(tcg_rm);
6208
 
    }
6209
 
 
6210
 
    write_fp_dreg(s, rd, tcg_rd);
6211
 
 
6212
 
    tcg_temp_free_i64(tcg_rd);
6213
 
}
6214
 
 
6215
 
/* C3.6.12 AdvSIMD scalar two reg misc
6216
 
 *  31 30  29 28       24 23  22 21       17 16    12 11 10 9    5 4    0
6217
 
 * +-----+---+-----------+------+-----------+--------+-----+------+------+
6218
 
 * | 0 1 | U | 1 1 1 1 0 | size | 1 0 0 0 0 | opcode | 1 0 |  Rn  |  Rd  |
6219
 
 * +-----+---+-----------+------+-----------+--------+-----+------+------+
6220
 
 */
6221
 
static void disas_simd_scalar_two_reg_misc(DisasContext *s, uint32_t insn)
6222
 
{
6223
 
    unsupported_encoding(s, insn);
6224
 
}
6225
 
 
6226
 
/* C3.6.13 AdvSIMD scalar x indexed element
6227
 
 *  31 30  29 28       24 23  22 21  20  19  16 15 12  11  10 9    5 4    0
6228
 
 * +-----+---+-----------+------+---+---+------+-----+---+---+------+------+
6229
 
 * | 0 1 | U | 1 1 1 1 1 | size | L | M |  Rm  | opc | H | 0 |  Rn  |  Rd  |
6230
 
 * +-----+---+-----------+------+---+---+------+-----+---+---+------+------+
6231
 
 */
6232
 
static void disas_simd_scalar_indexed(DisasContext *s, uint32_t insn)
6233
 
{
6234
 
    unsupported_encoding(s, insn);
6235
 
}
6236
 
 
6237
 
/* SSHR[RA]/USHR[RA] - Vector shift right (optional rounding/accumulate) */
6238
 
static void handle_vec_simd_shri(DisasContext *s, bool is_q, bool is_u,
6239
 
                                 int immh, int immb, int opcode, int rn, int rd)
6240
 
{
6241
 
    int size = 32 - clz32(immh) - 1;
6242
 
    int immhb = immh << 3 | immb;
6243
 
    int shift = 2 * (8 << size) - immhb;
6244
 
    bool accumulate = false;
6245
 
    bool round = false;
6246
 
    int dsize = is_q ? 128 : 64;
6247
 
    int esize = 8 << size;
6248
 
    int elements = dsize/esize;
6249
 
    TCGMemOp memop = size | (is_u ? 0 : MO_SIGN);
6250
 
    TCGv_i64 tcg_rn = new_tmp_a64(s);
6251
 
    TCGv_i64 tcg_rd = new_tmp_a64(s);
6252
 
    TCGv_i64 tcg_round;
6253
 
    int i;
6254
 
 
6255
 
    if (extract32(immh, 3, 1) && !is_q) {
6256
 
        unallocated_encoding(s);
6257
 
        return;
6258
 
    }
6259
 
 
6260
 
    if (size > 3 && !is_q) {
6261
 
        unallocated_encoding(s);
6262
 
        return;
6263
 
    }
6264
 
 
6265
 
    switch (opcode) {
6266
 
    case 0x02: /* SSRA / USRA (accumulate) */
6267
 
        accumulate = true;
6268
 
        break;
6269
 
    case 0x04: /* SRSHR / URSHR (rounding) */
6270
 
        round = true;
6271
 
        break;
6272
 
    case 0x06: /* SRSRA / URSRA (accum + rounding) */
6273
 
        accumulate = round = true;
6274
 
        break;
6275
 
    }
6276
 
 
6277
 
    if (round) {
6278
 
        uint64_t round_const = 1ULL << (shift - 1);
6279
 
        tcg_round = tcg_const_i64(round_const);
6280
 
    } else {
6281
 
        TCGV_UNUSED_I64(tcg_round);
6282
 
    }
6283
 
 
6284
 
    for (i = 0; i < elements; i++) {
6285
 
        read_vec_element(s, tcg_rn, rn, i, memop);
6286
 
        if (accumulate) {
6287
 
            read_vec_element(s, tcg_rd, rd, i, memop);
6288
 
        }
6289
 
 
6290
 
        handle_shri_with_rndacc(tcg_rd, tcg_rn, tcg_round,
6291
 
                                accumulate, is_u, size, shift);
6292
 
 
6293
 
        write_vec_element(s, tcg_rd, rd, i, size);
6294
 
    }
6295
 
 
6296
 
    if (!is_q) {
6297
 
        clear_vec_high(s, rd);
6298
 
    }
6299
 
 
6300
 
    if (round) {
6301
 
        tcg_temp_free_i64(tcg_round);
6302
 
    }
6303
 
}
6304
 
 
6305
 
/* SHL/SLI - Vector shift left */
6306
 
static void handle_vec_simd_shli(DisasContext *s, bool is_q, bool insert,
6307
 
                                int immh, int immb, int opcode, int rn, int rd)
6308
 
{
6309
 
    int size = 32 - clz32(immh) - 1;
6310
 
    int immhb = immh << 3 | immb;
6311
 
    int shift = immhb - (8 << size);
6312
 
    int dsize = is_q ? 128 : 64;
6313
 
    int esize = 8 << size;
6314
 
    int elements = dsize/esize;
6315
 
    TCGv_i64 tcg_rn = new_tmp_a64(s);
6316
 
    TCGv_i64 tcg_rd = new_tmp_a64(s);
6317
 
    int i;
6318
 
 
6319
 
    if (extract32(immh, 3, 1) && !is_q) {
6320
 
        unallocated_encoding(s);
6321
 
        return;
6322
 
    }
6323
 
 
6324
 
    if (size > 3 && !is_q) {
6325
 
        unallocated_encoding(s);
6326
 
        return;
6327
 
    }
6328
 
 
6329
 
    for (i = 0; i < elements; i++) {
6330
 
        read_vec_element(s, tcg_rn, rn, i, size);
6331
 
        if (insert) {
6332
 
            read_vec_element(s, tcg_rd, rd, i, size);
6333
 
        }
6334
 
 
6335
 
        handle_shli_with_ins(tcg_rd, tcg_rn, insert, shift);
6336
 
 
6337
 
        write_vec_element(s, tcg_rd, rd, i, size);
6338
 
    }
6339
 
 
6340
 
    if (!is_q) {
6341
 
        clear_vec_high(s, rd);
6342
 
    }
6343
 
}
6344
 
 
6345
 
/* USHLL/SHLL - Vector shift left with widening */
6346
 
static void handle_vec_simd_wshli(DisasContext *s, bool is_q, bool is_u,
6347
 
                                 int immh, int immb, int opcode, int rn, int rd)
6348
 
{
6349
 
    int size = 32 - clz32(immh) - 1;
6350
 
    int immhb = immh << 3 | immb;
6351
 
    int shift = immhb - (8 << size);
6352
 
    int dsize = 64;
6353
 
    int esize = 8 << size;
6354
 
    int elements = dsize/esize;
6355
 
    TCGv_i64 tcg_rn = new_tmp_a64(s);
6356
 
    TCGv_i64 tcg_rd = new_tmp_a64(s);
6357
 
    int i;
6358
 
 
6359
 
    if (size >= 3) {
6360
 
        unallocated_encoding(s);
6361
 
        return;
6362
 
    }
6363
 
 
6364
 
    /* For the LL variants the store is larger than the load,
6365
 
     * so if rd == rn we would overwrite parts of our input.
6366
 
     * So load everything right now and use shifts in the main loop.
6367
 
     */
6368
 
    read_vec_element(s, tcg_rn, rn, is_q ? 1 : 0, MO_64);
6369
 
 
6370
 
    for (i = 0; i < elements; i++) {
6371
 
        tcg_gen_shri_i64(tcg_rd, tcg_rn, i * esize);
6372
 
        ext_and_shift_reg(tcg_rd, tcg_rd, size | (!is_u << 2), 0);
6373
 
        tcg_gen_shli_i64(tcg_rd, tcg_rd, shift);
6374
 
        write_vec_element(s, tcg_rd, rd, i, size + 1);
6375
 
    }
6376
 
}
6377
 
 
6378
 
 
6379
 
/* C3.6.14 AdvSIMD shift by immediate
6380
 
 *  31  30   29 28         23 22  19 18  16 15    11  10 9    5 4    0
6381
 
 * +---+---+---+-------------+------+------+--------+---+------+------+
6382
 
 * | 0 | Q | U | 0 1 1 1 1 0 | immh | immb | opcode | 1 |  Rn  |  Rd  |
6383
 
 * +---+---+---+-------------+------+------+--------+---+------+------+
6384
 
 */
6385
 
static void disas_simd_shift_imm(DisasContext *s, uint32_t insn)
6386
 
{
6387
 
    int rd = extract32(insn, 0, 5);
6388
 
    int rn = extract32(insn, 5, 5);
6389
 
    int opcode = extract32(insn, 11, 5);
6390
 
    int immb = extract32(insn, 16, 3);
6391
 
    int immh = extract32(insn, 19, 4);
6392
 
    bool is_u = extract32(insn, 29, 1);
6393
 
    bool is_q = extract32(insn, 30, 1);
6394
 
 
6395
 
    switch (opcode) {
6396
 
    case 0x00: /* SSHR / USHR */
6397
 
    case 0x02: /* SSRA / USRA (accumulate) */
6398
 
    case 0x04: /* SRSHR / URSHR (rounding) */
6399
 
    case 0x06: /* SRSRA / URSRA (accum + rounding) */
6400
 
        handle_vec_simd_shri(s, is_q, is_u, immh, immb, opcode, rn, rd);
6401
 
        break;
6402
 
    case 0x0a: /* SHL / SLI */
6403
 
        handle_vec_simd_shli(s, is_q, is_u, immh, immb, opcode, rn, rd);
6404
 
        break;
6405
 
    case 0x14: /* SSHLL / USHLL */
6406
 
        handle_vec_simd_wshli(s, is_q, is_u, immh, immb, opcode, rn, rd);
6407
 
        break;
6408
 
    default:
6409
 
        /* We don't currently implement any of the Narrow or saturating shifts;
6410
 
         * nor do we implement the fixed-point conversions in this
6411
 
         * encoding group (SCVTF, FCVTZS, UCVTF, FCVTZU).
6412
 
         */
6413
 
        unsupported_encoding(s, insn);
6414
 
        return;
6415
 
    }
6416
 
}
6417
 
 
6418
 
static void handle_3rd_widening(DisasContext *s, int is_q, int is_u, int size,
6419
 
                                int opcode, int rd, int rn, int rm)
6420
 
{
6421
 
    /* 3-reg-different widening insns: 64 x 64 -> 128 */
6422
 
    TCGv_i64 tcg_res[2];
6423
 
    int pass, accop;
6424
 
 
6425
 
    tcg_res[0] = tcg_temp_new_i64();
6426
 
    tcg_res[1] = tcg_temp_new_i64();
6427
 
 
6428
 
    /* Does this op do an adding accumulate, a subtracting accumulate,
6429
 
     * or no accumulate at all?
6430
 
     */
6431
 
    switch (opcode) {
6432
 
    case 5:
6433
 
    case 8:
6434
 
    case 9:
6435
 
        accop = 1;
6436
 
        break;
6437
 
    case 10:
6438
 
    case 11:
6439
 
        accop = -1;
6440
 
        break;
6441
 
    default:
6442
 
        accop = 0;
6443
 
        break;
6444
 
    }
6445
 
 
6446
 
    if (accop != 0) {
6447
 
        read_vec_element(s, tcg_res[0], rd, 0, MO_64);
6448
 
        read_vec_element(s, tcg_res[1], rd, 1, MO_64);
6449
 
    }
6450
 
 
6451
 
    /* size == 2 means two 32x32->64 operations; this is worth special
6452
 
     * casing because we can generally handle it inline.
6453
 
     */
6454
 
    if (size == 2) {
6455
 
        for (pass = 0; pass < 2; pass++) {
6456
 
            TCGv_i64 tcg_op1 = tcg_temp_new_i64();
6457
 
            TCGv_i64 tcg_op2 = tcg_temp_new_i64();
6458
 
            TCGv_i64 tcg_passres;
6459
 
            TCGMemOp memop = MO_32 | (is_u ? 0 : MO_SIGN);
6460
 
 
6461
 
            int elt = pass + is_q * 2;
6462
 
 
6463
 
            read_vec_element(s, tcg_op1, rn, elt, memop);
6464
 
            read_vec_element(s, tcg_op2, rm, elt, memop);
6465
 
 
6466
 
            if (accop == 0) {
6467
 
                tcg_passres = tcg_res[pass];
6468
 
            } else {
6469
 
                tcg_passres = tcg_temp_new_i64();
6470
 
            }
6471
 
 
6472
 
            switch (opcode) {
6473
 
            case 5: /* SABAL, SABAL2, UABAL, UABAL2 */
6474
 
            case 7: /* SABDL, SABDL2, UABDL, UABDL2 */
6475
 
            {
6476
 
                TCGv_i64 tcg_tmp1 = tcg_temp_new_i64();
6477
 
                TCGv_i64 tcg_tmp2 = tcg_temp_new_i64();
6478
 
 
6479
 
                tcg_gen_sub_i64(tcg_tmp1, tcg_op1, tcg_op2);
6480
 
                tcg_gen_sub_i64(tcg_tmp2, tcg_op2, tcg_op1);
6481
 
                tcg_gen_movcond_i64(is_u ? TCG_COND_GEU : TCG_COND_GE,
6482
 
                                    tcg_passres,
6483
 
                                    tcg_op1, tcg_op2, tcg_tmp1, tcg_tmp2);
6484
 
                tcg_temp_free_i64(tcg_tmp1);
6485
 
                tcg_temp_free_i64(tcg_tmp2);
6486
 
                break;
6487
 
            }
6488
 
            case 8: /* SMLAL, SMLAL2, UMLAL, UMLAL2 */
6489
 
            case 10: /* SMLSL, SMLSL2, UMLSL, UMLSL2 */
6490
 
            case 12: /* UMULL, UMULL2, SMULL, SMULL2 */
6491
 
                tcg_gen_mul_i64(tcg_passres, tcg_op1, tcg_op2);
6492
 
                break;
6493
 
            default:
6494
 
                g_assert_not_reached();
6495
 
            }
6496
 
 
6497
 
            if (accop > 0) {
6498
 
                tcg_gen_add_i64(tcg_res[pass], tcg_res[pass], tcg_passres);
6499
 
                tcg_temp_free_i64(tcg_passres);
6500
 
            } else if (accop < 0) {
6501
 
                tcg_gen_sub_i64(tcg_res[pass], tcg_res[pass], tcg_passres);
6502
 
                tcg_temp_free_i64(tcg_passres);
6503
 
            }
6504
 
 
6505
 
            tcg_temp_free_i64(tcg_op1);
6506
 
            tcg_temp_free_i64(tcg_op2);
6507
 
        }
6508
 
    } else {
6509
 
        /* size 0 or 1, generally helper functions */
6510
 
        for (pass = 0; pass < 2; pass++) {
6511
 
            TCGv_i32 tcg_op1 = tcg_temp_new_i32();
6512
 
            TCGv_i32 tcg_op2 = tcg_temp_new_i32();
6513
 
            TCGv_i64 tcg_passres;
6514
 
            int elt = pass + is_q * 2;
6515
 
 
6516
 
            read_vec_element_i32(s, tcg_op1, rn, elt, MO_32);
6517
 
            read_vec_element_i32(s, tcg_op2, rm, elt, MO_32);
6518
 
 
6519
 
            if (accop == 0) {
6520
 
                tcg_passres = tcg_res[pass];
6521
 
            } else {
6522
 
                tcg_passres = tcg_temp_new_i64();
6523
 
            }
6524
 
 
6525
 
            switch (opcode) {
6526
 
            case 5: /* SABAL, SABAL2, UABAL, UABAL2 */
6527
 
            case 7: /* SABDL, SABDL2, UABDL, UABDL2 */
6528
 
                if (size == 0) {
6529
 
                    if (is_u) {
6530
 
                        gen_helper_neon_abdl_u16(tcg_passres, tcg_op1, tcg_op2);
6531
 
                    } else {
6532
 
                        gen_helper_neon_abdl_s16(tcg_passres, tcg_op1, tcg_op2);
6533
 
                    }
6534
 
                } else {
6535
 
                    if (is_u) {
6536
 
                        gen_helper_neon_abdl_u32(tcg_passres, tcg_op1, tcg_op2);
6537
 
                    } else {
6538
 
                        gen_helper_neon_abdl_s32(tcg_passres, tcg_op1, tcg_op2);
6539
 
                    }
6540
 
                }
6541
 
                break;
6542
 
            case 8: /* SMLAL, SMLAL2, UMLAL, UMLAL2 */
6543
 
            case 10: /* SMLSL, SMLSL2, UMLSL, UMLSL2 */
6544
 
            case 12: /* UMULL, UMULL2, SMULL, SMULL2 */
6545
 
                if (size == 0) {
6546
 
                    if (is_u) {
6547
 
                        gen_helper_neon_mull_u8(tcg_passres, tcg_op1, tcg_op2);
6548
 
                    } else {
6549
 
                        gen_helper_neon_mull_s8(tcg_passres, tcg_op1, tcg_op2);
6550
 
                    }
6551
 
                } else {
6552
 
                    if (is_u) {
6553
 
                        gen_helper_neon_mull_u16(tcg_passres, tcg_op1, tcg_op2);
6554
 
                    } else {
6555
 
                        gen_helper_neon_mull_s16(tcg_passres, tcg_op1, tcg_op2);
6556
 
                    }
6557
 
                }
6558
 
                break;
6559
 
            default:
6560
 
                g_assert_not_reached();
6561
 
            }
6562
 
            tcg_temp_free_i32(tcg_op1);
6563
 
            tcg_temp_free_i32(tcg_op2);
6564
 
 
6565
 
            if (accop > 0) {
6566
 
                if (size == 0) {
6567
 
                    gen_helper_neon_addl_u16(tcg_res[pass], tcg_res[pass],
6568
 
                                             tcg_passres);
6569
 
                } else {
6570
 
                    gen_helper_neon_addl_u32(tcg_res[pass], tcg_res[pass],
6571
 
                                             tcg_passres);
6572
 
                }
6573
 
                tcg_temp_free_i64(tcg_passres);
6574
 
            } else if (accop < 0) {
6575
 
                if (size == 0) {
6576
 
                    gen_helper_neon_subl_u16(tcg_res[pass], tcg_res[pass],
6577
 
                                             tcg_passres);
6578
 
                } else {
6579
 
                    gen_helper_neon_subl_u32(tcg_res[pass], tcg_res[pass],
6580
 
                                             tcg_passres);
6581
 
                }
6582
 
                tcg_temp_free_i64(tcg_passres);
6583
 
            }
6584
 
        }
6585
 
    }
6586
 
 
6587
 
    write_vec_element(s, tcg_res[0], rd, 0, MO_64);
6588
 
    write_vec_element(s, tcg_res[1], rd, 1, MO_64);
6589
 
    tcg_temp_free_i64(tcg_res[0]);
6590
 
    tcg_temp_free_i64(tcg_res[1]);
6591
 
}
6592
 
 
6593
 
/* C3.6.15 AdvSIMD three different
6594
 
 *   31  30  29 28       24 23  22  21 20  16 15    12 11 10 9    5 4    0
6595
 
 * +---+---+---+-----------+------+---+------+--------+-----+------+------+
6596
 
 * | 0 | Q | U | 0 1 1 1 0 | size | 1 |  Rm  | opcode | 0 0 |  Rn  |  Rd  |
6597
 
 * +---+---+---+-----------+------+---+------+--------+-----+------+------+
6598
 
 */
6599
 
static void disas_simd_three_reg_diff(DisasContext *s, uint32_t insn)
6600
 
{
6601
 
    /* Instructions in this group fall into three basic classes
6602
 
     * (in each case with the operation working on each element in
6603
 
     * the input vectors):
6604
 
     * (1) widening 64 x 64 -> 128 (with possibly Vd as an extra
6605
 
     *     128 bit input)
6606
 
     * (2) wide 64 x 128 -> 128
6607
 
     * (3) narrowing 128 x 128 -> 64
6608
 
     * Here we do initial decode, catch unallocated cases and
6609
 
     * dispatch to separate functions for each class.
6610
 
     */
6611
 
    int is_q = extract32(insn, 30, 1);
6612
 
    int is_u = extract32(insn, 29, 1);
6613
 
    int size = extract32(insn, 22, 2);
6614
 
    int opcode = extract32(insn, 12, 4);
6615
 
    int rm = extract32(insn, 16, 5);
6616
 
    int rn = extract32(insn, 5, 5);
6617
 
    int rd = extract32(insn, 0, 5);
6618
 
 
6619
 
    switch (opcode) {
6620
 
    case 1: /* SADDW, SADDW2, UADDW, UADDW2 */
6621
 
    case 3: /* SSUBW, SSUBW2, USUBW, USUBW2 */
6622
 
        /* 64 x 128 -> 128 */
6623
 
        unsupported_encoding(s, insn);
6624
 
        break;
6625
 
    case 4: /* ADDHN, ADDHN2, RADDHN, RADDHN2 */
6626
 
    case 6: /* SUBHN, SUBHN2, RSUBHN, RSUBHN2 */
6627
 
        /* 128 x 128 -> 64 */
6628
 
        unsupported_encoding(s, insn);
6629
 
        break;
6630
 
    case 9:
6631
 
    case 11:
6632
 
    case 13:
6633
 
    case 14:
6634
 
        if (is_u) {
6635
 
            unallocated_encoding(s);
6636
 
            return;
6637
 
        }
6638
 
        /* fall through */
6639
 
    case 0:
6640
 
    case 2:
6641
 
        unsupported_encoding(s, insn);
6642
 
        break;
6643
 
    case 5:
6644
 
    case 7:
6645
 
    case 8:
6646
 
    case 10:
6647
 
    case 12:
6648
 
        /* 64 x 64 -> 128 */
6649
 
        if (size == 3) {
6650
 
            unallocated_encoding(s);
6651
 
            return;
6652
 
        }
6653
 
        handle_3rd_widening(s, is_q, is_u, size, opcode, rd, rn, rm);
6654
 
        break;
6655
 
    default:
6656
 
        /* opcode 15 not allocated */
6657
 
        unallocated_encoding(s);
6658
 
        break;
6659
 
    }
6660
 
}
6661
 
 
6662
 
/* Logic op (opcode == 3) subgroup of C3.6.16. */
6663
 
static void disas_simd_3same_logic(DisasContext *s, uint32_t insn)
6664
 
{
6665
 
    int rd = extract32(insn, 0, 5);
6666
 
    int rn = extract32(insn, 5, 5);
6667
 
    int rm = extract32(insn, 16, 5);
6668
 
    int size = extract32(insn, 22, 2);
6669
 
    bool is_u = extract32(insn, 29, 1);
6670
 
    bool is_q = extract32(insn, 30, 1);
6671
 
    TCGv_i64 tcg_op1 = tcg_temp_new_i64();
6672
 
    TCGv_i64 tcg_op2 = tcg_temp_new_i64();
6673
 
    TCGv_i64 tcg_res[2];
6674
 
    int pass;
6675
 
 
6676
 
    tcg_res[0] = tcg_temp_new_i64();
6677
 
    tcg_res[1] = tcg_temp_new_i64();
6678
 
 
6679
 
    for (pass = 0; pass < (is_q ? 2 : 1); pass++) {
6680
 
        read_vec_element(s, tcg_op1, rn, pass, MO_64);
6681
 
        read_vec_element(s, tcg_op2, rm, pass, MO_64);
6682
 
 
6683
 
        if (!is_u) {
6684
 
            switch (size) {
6685
 
            case 0: /* AND */
6686
 
                tcg_gen_and_i64(tcg_res[pass], tcg_op1, tcg_op2);
6687
 
                break;
6688
 
            case 1: /* BIC */
6689
 
                tcg_gen_andc_i64(tcg_res[pass], tcg_op1, tcg_op2);
6690
 
                break;
6691
 
            case 2: /* ORR */
6692
 
                tcg_gen_or_i64(tcg_res[pass], tcg_op1, tcg_op2);
6693
 
                break;
6694
 
            case 3: /* ORN */
6695
 
                tcg_gen_orc_i64(tcg_res[pass], tcg_op1, tcg_op2);
6696
 
                break;
6697
 
            }
6698
 
        } else {
6699
 
            if (size != 0) {
6700
 
                /* B* ops need res loaded to operate on */
6701
 
                read_vec_element(s, tcg_res[pass], rd, pass, MO_64);
6702
 
            }
6703
 
 
6704
 
            switch (size) {
6705
 
            case 0: /* EOR */
6706
 
                tcg_gen_xor_i64(tcg_res[pass], tcg_op1, tcg_op2);
6707
 
                break;
6708
 
            case 1: /* BSL bitwise select */
6709
 
                tcg_gen_xor_i64(tcg_op1, tcg_op1, tcg_op2);
6710
 
                tcg_gen_and_i64(tcg_op1, tcg_op1, tcg_res[pass]);
6711
 
                tcg_gen_xor_i64(tcg_res[pass], tcg_op2, tcg_op1);
6712
 
                break;
6713
 
            case 2: /* BIT, bitwise insert if true */
6714
 
                tcg_gen_xor_i64(tcg_op1, tcg_op1, tcg_res[pass]);
6715
 
                tcg_gen_and_i64(tcg_op1, tcg_op1, tcg_op2);
6716
 
                tcg_gen_xor_i64(tcg_res[pass], tcg_res[pass], tcg_op1);
6717
 
                break;
6718
 
            case 3: /* BIF, bitwise insert if false */
6719
 
                tcg_gen_xor_i64(tcg_op1, tcg_op1, tcg_res[pass]);
6720
 
                tcg_gen_andc_i64(tcg_op1, tcg_op1, tcg_op2);
6721
 
                tcg_gen_xor_i64(tcg_res[pass], tcg_res[pass], tcg_op1);
6722
 
                break;
6723
 
            }
6724
 
        }
6725
 
    }
6726
 
 
6727
 
    write_vec_element(s, tcg_res[0], rd, 0, MO_64);
6728
 
    if (!is_q) {
6729
 
        tcg_gen_movi_i64(tcg_res[1], 0);
6730
 
    }
6731
 
    write_vec_element(s, tcg_res[1], rd, 1, MO_64);
6732
 
 
6733
 
    tcg_temp_free_i64(tcg_op1);
6734
 
    tcg_temp_free_i64(tcg_op2);
6735
 
    tcg_temp_free_i64(tcg_res[0]);
6736
 
    tcg_temp_free_i64(tcg_res[1]);
6737
 
}
6738
 
 
6739
 
/* Helper functions for 32 bit comparisons */
6740
 
static void gen_max_s32(TCGv_i32 res, TCGv_i32 op1, TCGv_i32 op2)
6741
 
{
6742
 
    tcg_gen_movcond_i32(TCG_COND_GE, res, op1, op2, op1, op2);
6743
 
}
6744
 
 
6745
 
static void gen_max_u32(TCGv_i32 res, TCGv_i32 op1, TCGv_i32 op2)
6746
 
{
6747
 
    tcg_gen_movcond_i32(TCG_COND_GEU, res, op1, op2, op1, op2);
6748
 
}
6749
 
 
6750
 
static void gen_min_s32(TCGv_i32 res, TCGv_i32 op1, TCGv_i32 op2)
6751
 
{
6752
 
    tcg_gen_movcond_i32(TCG_COND_LE, res, op1, op2, op1, op2);
6753
 
}
6754
 
 
6755
 
static void gen_min_u32(TCGv_i32 res, TCGv_i32 op1, TCGv_i32 op2)
6756
 
{
6757
 
    tcg_gen_movcond_i32(TCG_COND_LEU, res, op1, op2, op1, op2);
6758
 
}
6759
 
 
6760
 
/* Pairwise op subgroup of C3.6.16. */
6761
 
static void disas_simd_3same_pair(DisasContext *s, uint32_t insn)
6762
 
{
6763
 
    int is_q = extract32(insn, 30, 1);
6764
 
    int u = extract32(insn, 29, 1);
6765
 
    int size = extract32(insn, 22, 2);
6766
 
    int opcode = extract32(insn, 11, 5);
6767
 
    int rm = extract32(insn, 16, 5);
6768
 
    int rn = extract32(insn, 5, 5);
6769
 
    int rd = extract32(insn, 0, 5);
6770
 
    int pass;
6771
 
 
6772
 
    if (size == 3 && !is_q) {
6773
 
        unallocated_encoding(s);
6774
 
        return;
6775
 
    }
6776
 
 
6777
 
    switch (opcode) {
6778
 
    case 0x14: /* SMAXP, UMAXP */
6779
 
    case 0x15: /* SMINP, UMINP */
6780
 
        if (size == 3) {
6781
 
            unallocated_encoding(s);
6782
 
            return;
6783
 
        }
6784
 
        break;
6785
 
    case 0x17:
6786
 
        if (u) {
6787
 
            unallocated_encoding(s);
6788
 
            return;
6789
 
        }
6790
 
        break;
6791
 
    default:
6792
 
        g_assert_not_reached();
6793
 
    }
6794
 
 
6795
 
    /* These operations work on the concatenated rm:rn, with each pair of
6796
 
     * adjacent elements being operated on to produce an element in the result.
6797
 
     */
6798
 
    if (size == 3) {
6799
 
        TCGv_i64 tcg_res[2];
6800
 
 
6801
 
        for (pass = 0; pass < 2; pass++) {
6802
 
            TCGv_i64 tcg_op1 = tcg_temp_new_i64();
6803
 
            TCGv_i64 tcg_op2 = tcg_temp_new_i64();
6804
 
            int passreg = (pass == 0) ? rn : rm;
6805
 
 
6806
 
            read_vec_element(s, tcg_op1, passreg, 0, MO_64);
6807
 
            read_vec_element(s, tcg_op2, passreg, 1, MO_64);
6808
 
            tcg_res[pass] = tcg_temp_new_i64();
6809
 
 
6810
 
            /* The only 64 bit pairwise integer op is ADDP */
6811
 
            assert(opcode == 0x17);
6812
 
            tcg_gen_add_i64(tcg_res[pass], tcg_op1, tcg_op2);
6813
 
 
6814
 
            tcg_temp_free_i64(tcg_op1);
6815
 
            tcg_temp_free_i64(tcg_op2);
6816
 
        }
6817
 
 
6818
 
        for (pass = 0; pass < 2; pass++) {
6819
 
            write_vec_element(s, tcg_res[pass], rd, pass, MO_64);
6820
 
            tcg_temp_free_i64(tcg_res[pass]);
6821
 
        }
6822
 
    } else {
6823
 
        int maxpass = is_q ? 4 : 2;
6824
 
        TCGv_i32 tcg_res[4];
6825
 
 
6826
 
        for (pass = 0; pass < maxpass; pass++) {
6827
 
            TCGv_i32 tcg_op1 = tcg_temp_new_i32();
6828
 
            TCGv_i32 tcg_op2 = tcg_temp_new_i32();
6829
 
            NeonGenTwoOpFn *genfn;
6830
 
            int passreg = pass < (maxpass / 2) ? rn : rm;
6831
 
            int passelt = (is_q && (pass & 1)) ? 2 : 0;
6832
 
 
6833
 
            read_vec_element_i32(s, tcg_op1, passreg, passelt, MO_32);
6834
 
            read_vec_element_i32(s, tcg_op2, passreg, passelt + 1, MO_32);
6835
 
            tcg_res[pass] = tcg_temp_new_i32();
6836
 
 
6837
 
            switch (opcode) {
6838
 
            case 0x17: /* ADDP */
6839
 
            {
6840
 
                static NeonGenTwoOpFn * const fns[3] = {
6841
 
                    gen_helper_neon_padd_u8,
6842
 
                    gen_helper_neon_padd_u16,
6843
 
                    tcg_gen_add_i32,
6844
 
                };
6845
 
                genfn = fns[size];
6846
 
                break;
6847
 
            }
6848
 
            case 0x14: /* SMAXP, UMAXP */
6849
 
            {
6850
 
                static NeonGenTwoOpFn * const fns[3][2] = {
6851
 
                    { gen_helper_neon_pmax_s8, gen_helper_neon_pmax_u8 },
6852
 
                    { gen_helper_neon_pmax_s16, gen_helper_neon_pmax_u16 },
6853
 
                    { gen_max_s32, gen_max_u32 },
6854
 
                };
6855
 
                genfn = fns[size][u];
6856
 
                break;
6857
 
            }
6858
 
            case 0x15: /* SMINP, UMINP */
6859
 
            {
6860
 
                static NeonGenTwoOpFn * const fns[3][2] = {
6861
 
                    { gen_helper_neon_pmin_s8, gen_helper_neon_pmin_u8 },
6862
 
                    { gen_helper_neon_pmin_s16, gen_helper_neon_pmin_u16 },
6863
 
                    { gen_min_s32, gen_min_u32 },
6864
 
                };
6865
 
                genfn = fns[size][u];
6866
 
                break;
6867
 
            }
6868
 
            default:
6869
 
                g_assert_not_reached();
6870
 
            }
6871
 
 
6872
 
            genfn(tcg_res[pass], tcg_op1, tcg_op2);
6873
 
 
6874
 
            tcg_temp_free_i32(tcg_op1);
6875
 
            tcg_temp_free_i32(tcg_op2);
6876
 
        }
6877
 
 
6878
 
        for (pass = 0; pass < maxpass; pass++) {
6879
 
            write_vec_element_i32(s, tcg_res[pass], rd, pass, MO_32);
6880
 
            tcg_temp_free_i32(tcg_res[pass]);
6881
 
        }
6882
 
        if (!is_q) {
6883
 
            clear_vec_high(s, rd);
6884
 
        }
6885
 
    }
6886
 
}
6887
 
 
6888
 
/* Floating point op subgroup of C3.6.16. */
6889
 
static void disas_simd_3same_float(DisasContext *s, uint32_t insn)
6890
 
{
6891
 
    /* For floating point ops, the U, size[1] and opcode bits
6892
 
     * together indicate the operation. size[0] indicates single
6893
 
     * or double.
6894
 
     */
6895
 
    int fpopcode = extract32(insn, 11, 5)
6896
 
        | (extract32(insn, 23, 1) << 5)
6897
 
        | (extract32(insn, 29, 1) << 6);
6898
 
    int is_q = extract32(insn, 30, 1);
6899
 
    int size = extract32(insn, 22, 1);
6900
 
    int rm = extract32(insn, 16, 5);
6901
 
    int rn = extract32(insn, 5, 5);
6902
 
    int rd = extract32(insn, 0, 5);
6903
 
 
6904
 
    int datasize = is_q ? 128 : 64;
6905
 
    int esize = 32 << size;
6906
 
    int elements = datasize / esize;
6907
 
 
6908
 
    if (size == 1 && !is_q) {
6909
 
        unallocated_encoding(s);
6910
 
        return;
6911
 
    }
6912
 
 
6913
 
    switch (fpopcode) {
6914
 
    case 0x58: /* FMAXNMP */
6915
 
    case 0x5a: /* FADDP */
6916
 
    case 0x5e: /* FMAXP */
6917
 
    case 0x78: /* FMINNMP */
6918
 
    case 0x7e: /* FMINP */
6919
 
        /* pairwise ops */
6920
 
        unsupported_encoding(s, insn);
6921
 
        return;
6922
 
    case 0x1b: /* FMULX */
6923
 
    case 0x1c: /* FCMEQ */
6924
 
    case 0x1f: /* FRECPS */
6925
 
    case 0x3f: /* FRSQRTS */
6926
 
    case 0x5c: /* FCMGE */
6927
 
    case 0x5d: /* FACGE */
6928
 
    case 0x7c: /* FCMGT */
6929
 
    case 0x7d: /* FACGT */
6930
 
    case 0x19: /* FMLA */
6931
 
    case 0x39: /* FMLS */
6932
 
        unsupported_encoding(s, insn);
6933
 
        return;
6934
 
    case 0x18: /* FMAXNM */
6935
 
    case 0x1a: /* FADD */
6936
 
    case 0x1e: /* FMAX */
6937
 
    case 0x38: /* FMINNM */
6938
 
    case 0x3a: /* FSUB */
6939
 
    case 0x3e: /* FMIN */
6940
 
    case 0x5b: /* FMUL */
6941
 
    case 0x5f: /* FDIV */
6942
 
    case 0x7a: /* FABD */
6943
 
        handle_3same_float(s, size, elements, fpopcode, rd, rn, rm);
6944
 
        return;
6945
 
    default:
6946
 
        unallocated_encoding(s);
6947
 
        return;
6948
 
    }
6949
 
}
6950
 
 
6951
 
/* Integer op subgroup of C3.6.16. */
6952
 
static void disas_simd_3same_int(DisasContext *s, uint32_t insn)
6953
 
{
6954
 
    int is_q = extract32(insn, 30, 1);
6955
 
    int u = extract32(insn, 29, 1);
6956
 
    int size = extract32(insn, 22, 2);
6957
 
    int opcode = extract32(insn, 11, 5);
6958
 
    int rm = extract32(insn, 16, 5);
6959
 
    int rn = extract32(insn, 5, 5);
6960
 
    int rd = extract32(insn, 0, 5);
6961
 
    int pass;
6962
 
 
6963
 
    switch (opcode) {
6964
 
    case 0x13: /* MUL, PMUL */
6965
 
        if (u && size != 0) {
6966
 
            unallocated_encoding(s);
6967
 
            return;
6968
 
        }
6969
 
        /* fall through */
6970
 
    case 0x0: /* SHADD, UHADD */
6971
 
    case 0x2: /* SRHADD, URHADD */
6972
 
    case 0x4: /* SHSUB, UHSUB */
6973
 
    case 0xc: /* SMAX, UMAX */
6974
 
    case 0xd: /* SMIN, UMIN */
6975
 
    case 0xe: /* SABD, UABD */
6976
 
    case 0xf: /* SABA, UABA */
6977
 
    case 0x12: /* MLA, MLS */
6978
 
        if (size == 3) {
6979
 
            unallocated_encoding(s);
6980
 
            return;
6981
 
        }
6982
 
        break;
6983
 
    case 0x16: /* SQDMULH, SQRDMULH */
6984
 
        if (size == 0 || size == 3) {
6985
 
            unallocated_encoding(s);
6986
 
            return;
6987
 
        }
6988
 
        break;
6989
 
    default:
6990
 
        if (size == 3 && !is_q) {
6991
 
            unallocated_encoding(s);
6992
 
            return;
6993
 
        }
6994
 
        break;
6995
 
    }
6996
 
 
6997
 
    if (size == 3) {
6998
 
        for (pass = 0; pass < (is_q ? 2 : 1); pass++) {
6999
 
            TCGv_i64 tcg_op1 = tcg_temp_new_i64();
7000
 
            TCGv_i64 tcg_op2 = tcg_temp_new_i64();
7001
 
            TCGv_i64 tcg_res = tcg_temp_new_i64();
7002
 
 
7003
 
            read_vec_element(s, tcg_op1, rn, pass, MO_64);
7004
 
            read_vec_element(s, tcg_op2, rm, pass, MO_64);
7005
 
 
7006
 
            handle_3same_64(s, opcode, u, tcg_res, tcg_op1, tcg_op2);
7007
 
 
7008
 
            write_vec_element(s, tcg_res, rd, pass, MO_64);
7009
 
 
7010
 
            tcg_temp_free_i64(tcg_res);
7011
 
            tcg_temp_free_i64(tcg_op1);
7012
 
            tcg_temp_free_i64(tcg_op2);
7013
 
        }
7014
 
    } else {
7015
 
        for (pass = 0; pass < (is_q ? 4 : 2); pass++) {
7016
 
            TCGv_i32 tcg_op1 = tcg_temp_new_i32();
7017
 
            TCGv_i32 tcg_op2 = tcg_temp_new_i32();
7018
 
            TCGv_i32 tcg_res = tcg_temp_new_i32();
7019
 
            NeonGenTwoOpFn *genfn = NULL;
7020
 
            NeonGenTwoOpEnvFn *genenvfn = NULL;
7021
 
 
7022
 
            read_vec_element_i32(s, tcg_op1, rn, pass, MO_32);
7023
 
            read_vec_element_i32(s, tcg_op2, rm, pass, MO_32);
7024
 
 
7025
 
            switch (opcode) {
7026
 
            case 0x0: /* SHADD, UHADD */
7027
 
            {
7028
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7029
 
                    { gen_helper_neon_hadd_s8, gen_helper_neon_hadd_u8 },
7030
 
                    { gen_helper_neon_hadd_s16, gen_helper_neon_hadd_u16 },
7031
 
                    { gen_helper_neon_hadd_s32, gen_helper_neon_hadd_u32 },
7032
 
                };
7033
 
                genfn = fns[size][u];
7034
 
                break;
7035
 
            }
7036
 
            case 0x1: /* SQADD, UQADD */
7037
 
            {
7038
 
                static NeonGenTwoOpEnvFn * const fns[3][2] = {
7039
 
                    { gen_helper_neon_qadd_s8, gen_helper_neon_qadd_u8 },
7040
 
                    { gen_helper_neon_qadd_s16, gen_helper_neon_qadd_u16 },
7041
 
                    { gen_helper_neon_qadd_s32, gen_helper_neon_qadd_u32 },
7042
 
                };
7043
 
                genenvfn = fns[size][u];
7044
 
                break;
7045
 
            }
7046
 
            case 0x2: /* SRHADD, URHADD */
7047
 
            {
7048
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7049
 
                    { gen_helper_neon_rhadd_s8, gen_helper_neon_rhadd_u8 },
7050
 
                    { gen_helper_neon_rhadd_s16, gen_helper_neon_rhadd_u16 },
7051
 
                    { gen_helper_neon_rhadd_s32, gen_helper_neon_rhadd_u32 },
7052
 
                };
7053
 
                genfn = fns[size][u];
7054
 
                break;
7055
 
            }
7056
 
            case 0x4: /* SHSUB, UHSUB */
7057
 
            {
7058
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7059
 
                    { gen_helper_neon_hsub_s8, gen_helper_neon_hsub_u8 },
7060
 
                    { gen_helper_neon_hsub_s16, gen_helper_neon_hsub_u16 },
7061
 
                    { gen_helper_neon_hsub_s32, gen_helper_neon_hsub_u32 },
7062
 
                };
7063
 
                genfn = fns[size][u];
7064
 
                break;
7065
 
            }
7066
 
            case 0x5: /* SQSUB, UQSUB */
7067
 
            {
7068
 
                static NeonGenTwoOpEnvFn * const fns[3][2] = {
7069
 
                    { gen_helper_neon_qsub_s8, gen_helper_neon_qsub_u8 },
7070
 
                    { gen_helper_neon_qsub_s16, gen_helper_neon_qsub_u16 },
7071
 
                    { gen_helper_neon_qsub_s32, gen_helper_neon_qsub_u32 },
7072
 
                };
7073
 
                genenvfn = fns[size][u];
7074
 
                break;
7075
 
            }
7076
 
            case 0x6: /* CMGT, CMHI */
7077
 
            {
7078
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7079
 
                    { gen_helper_neon_cgt_s8, gen_helper_neon_cgt_u8 },
7080
 
                    { gen_helper_neon_cgt_s16, gen_helper_neon_cgt_u16 },
7081
 
                    { gen_helper_neon_cgt_s32, gen_helper_neon_cgt_u32 },
7082
 
                };
7083
 
                genfn = fns[size][u];
7084
 
                break;
7085
 
            }
7086
 
            case 0x7: /* CMGE, CMHS */
7087
 
            {
7088
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7089
 
                    { gen_helper_neon_cge_s8, gen_helper_neon_cge_u8 },
7090
 
                    { gen_helper_neon_cge_s16, gen_helper_neon_cge_u16 },
7091
 
                    { gen_helper_neon_cge_s32, gen_helper_neon_cge_u32 },
7092
 
                };
7093
 
                genfn = fns[size][u];
7094
 
                break;
7095
 
            }
7096
 
            case 0x8: /* SSHL, USHL */
7097
 
            {
7098
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7099
 
                    { gen_helper_neon_shl_s8, gen_helper_neon_shl_u8 },
7100
 
                    { gen_helper_neon_shl_s16, gen_helper_neon_shl_u16 },
7101
 
                    { gen_helper_neon_shl_s32, gen_helper_neon_shl_u32 },
7102
 
                };
7103
 
                genfn = fns[size][u];
7104
 
                break;
7105
 
            }
7106
 
            case 0x9: /* SQSHL, UQSHL */
7107
 
            {
7108
 
                static NeonGenTwoOpEnvFn * const fns[3][2] = {
7109
 
                    { gen_helper_neon_qshl_s8, gen_helper_neon_qshl_u8 },
7110
 
                    { gen_helper_neon_qshl_s16, gen_helper_neon_qshl_u16 },
7111
 
                    { gen_helper_neon_qshl_s32, gen_helper_neon_qshl_u32 },
7112
 
                };
7113
 
                genenvfn = fns[size][u];
7114
 
                break;
7115
 
            }
7116
 
            case 0xa: /* SRSHL, URSHL */
7117
 
            {
7118
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7119
 
                    { gen_helper_neon_rshl_s8, gen_helper_neon_rshl_u8 },
7120
 
                    { gen_helper_neon_rshl_s16, gen_helper_neon_rshl_u16 },
7121
 
                    { gen_helper_neon_rshl_s32, gen_helper_neon_rshl_u32 },
7122
 
                };
7123
 
                genfn = fns[size][u];
7124
 
                break;
7125
 
            }
7126
 
            case 0xb: /* SQRSHL, UQRSHL */
7127
 
            {
7128
 
                static NeonGenTwoOpEnvFn * const fns[3][2] = {
7129
 
                    { gen_helper_neon_qrshl_s8, gen_helper_neon_qrshl_u8 },
7130
 
                    { gen_helper_neon_qrshl_s16, gen_helper_neon_qrshl_u16 },
7131
 
                    { gen_helper_neon_qrshl_s32, gen_helper_neon_qrshl_u32 },
7132
 
                };
7133
 
                genenvfn = fns[size][u];
7134
 
                break;
7135
 
            }
7136
 
            case 0xc: /* SMAX, UMAX */
7137
 
            {
7138
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7139
 
                    { gen_helper_neon_max_s8, gen_helper_neon_max_u8 },
7140
 
                    { gen_helper_neon_max_s16, gen_helper_neon_max_u16 },
7141
 
                    { gen_max_s32, gen_max_u32 },
7142
 
                };
7143
 
                genfn = fns[size][u];
7144
 
                break;
7145
 
            }
7146
 
 
7147
 
            case 0xd: /* SMIN, UMIN */
7148
 
            {
7149
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7150
 
                    { gen_helper_neon_min_s8, gen_helper_neon_min_u8 },
7151
 
                    { gen_helper_neon_min_s16, gen_helper_neon_min_u16 },
7152
 
                    { gen_min_s32, gen_min_u32 },
7153
 
                };
7154
 
                genfn = fns[size][u];
7155
 
                break;
7156
 
            }
7157
 
            case 0xe: /* SABD, UABD */
7158
 
            case 0xf: /* SABA, UABA */
7159
 
            {
7160
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7161
 
                    { gen_helper_neon_abd_s8, gen_helper_neon_abd_u8 },
7162
 
                    { gen_helper_neon_abd_s16, gen_helper_neon_abd_u16 },
7163
 
                    { gen_helper_neon_abd_s32, gen_helper_neon_abd_u32 },
7164
 
                };
7165
 
                genfn = fns[size][u];
7166
 
                break;
7167
 
            }
7168
 
            case 0x10: /* ADD, SUB */
7169
 
            {
7170
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7171
 
                    { gen_helper_neon_add_u8, gen_helper_neon_sub_u8 },
7172
 
                    { gen_helper_neon_add_u16, gen_helper_neon_sub_u16 },
7173
 
                    { tcg_gen_add_i32, tcg_gen_sub_i32 },
7174
 
                };
7175
 
                genfn = fns[size][u];
7176
 
                break;
7177
 
            }
7178
 
            case 0x11: /* CMTST, CMEQ */
7179
 
            {
7180
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7181
 
                    { gen_helper_neon_tst_u8, gen_helper_neon_ceq_u8 },
7182
 
                    { gen_helper_neon_tst_u16, gen_helper_neon_ceq_u16 },
7183
 
                    { gen_helper_neon_tst_u32, gen_helper_neon_ceq_u32 },
7184
 
                };
7185
 
                genfn = fns[size][u];
7186
 
                break;
7187
 
            }
7188
 
            case 0x13: /* MUL, PMUL */
7189
 
                if (u) {
7190
 
                    /* PMUL */
7191
 
                    assert(size == 0);
7192
 
                    genfn = gen_helper_neon_mul_p8;
7193
 
                    break;
7194
 
                }
7195
 
                /* fall through : MUL */
7196
 
            case 0x12: /* MLA, MLS */
7197
 
            {
7198
 
                static NeonGenTwoOpFn * const fns[3] = {
7199
 
                    gen_helper_neon_mul_u8,
7200
 
                    gen_helper_neon_mul_u16,
7201
 
                    tcg_gen_mul_i32,
7202
 
                };
7203
 
                genfn = fns[size];
7204
 
                break;
7205
 
            }
7206
 
            case 0x16: /* SQDMULH, SQRDMULH */
7207
 
            {
7208
 
                static NeonGenTwoOpEnvFn * const fns[2][2] = {
7209
 
                    { gen_helper_neon_qdmulh_s16, gen_helper_neon_qrdmulh_s16 },
7210
 
                    { gen_helper_neon_qdmulh_s32, gen_helper_neon_qrdmulh_s32 },
7211
 
                };
7212
 
                assert(size == 1 || size == 2);
7213
 
                genenvfn = fns[size - 1][u];
7214
 
                break;
7215
 
            }
7216
 
            default:
7217
 
                g_assert_not_reached();
7218
 
            }
7219
 
 
7220
 
            if (genenvfn) {
7221
 
                genenvfn(tcg_res, cpu_env, tcg_op1, tcg_op2);
7222
 
            } else {
7223
 
                genfn(tcg_res, tcg_op1, tcg_op2);
7224
 
            }
7225
 
 
7226
 
            if (opcode == 0xf || opcode == 0x12) {
7227
 
                /* SABA, UABA, MLA, MLS: accumulating ops */
7228
 
                static NeonGenTwoOpFn * const fns[3][2] = {
7229
 
                    { gen_helper_neon_add_u8, gen_helper_neon_sub_u8 },
7230
 
                    { gen_helper_neon_add_u16, gen_helper_neon_sub_u16 },
7231
 
                    { tcg_gen_add_i32, tcg_gen_sub_i32 },
7232
 
                };
7233
 
                bool is_sub = (opcode == 0x12 && u); /* MLS */
7234
 
 
7235
 
                genfn = fns[size][is_sub];
7236
 
                read_vec_element_i32(s, tcg_op1, rd, pass, MO_32);
7237
 
                genfn(tcg_res, tcg_res, tcg_op1);
7238
 
            }
7239
 
 
7240
 
            write_vec_element_i32(s, tcg_res, rd, pass, MO_32);
7241
 
 
7242
 
            tcg_temp_free_i32(tcg_res);
7243
 
            tcg_temp_free_i32(tcg_op1);
7244
 
            tcg_temp_free_i32(tcg_op2);
7245
 
        }
7246
 
    }
7247
 
 
7248
 
    if (!is_q) {
7249
 
        clear_vec_high(s, rd);
7250
 
    }
7251
 
}
7252
 
 
7253
 
/* C3.6.16 AdvSIMD three same
7254
 
 *  31  30  29  28       24 23  22  21 20  16 15    11  10 9    5 4    0
7255
 
 * +---+---+---+-----------+------+---+------+--------+---+------+------+
7256
 
 * | 0 | Q | U | 0 1 1 1 0 | size | 1 |  Rm  | opcode | 1 |  Rn  |  Rd  |
7257
 
 * +---+---+---+-----------+------+---+------+--------+---+------+------+
7258
 
 */
7259
 
static void disas_simd_three_reg_same(DisasContext *s, uint32_t insn)
7260
 
{
7261
 
    int opcode = extract32(insn, 11, 5);
7262
 
 
7263
 
    switch (opcode) {
7264
 
    case 0x3: /* logic ops */
7265
 
        disas_simd_3same_logic(s, insn);
7266
 
        break;
7267
 
    case 0x17: /* ADDP */
7268
 
    case 0x14: /* SMAXP, UMAXP */
7269
 
    case 0x15: /* SMINP, UMINP */
7270
 
        /* Pairwise operations */
7271
 
        disas_simd_3same_pair(s, insn);
7272
 
        break;
7273
 
    case 0x18 ... 0x31:
7274
 
        /* floating point ops, sz[1] and U are part of opcode */
7275
 
        disas_simd_3same_float(s, insn);
7276
 
        break;
7277
 
    default:
7278
 
        disas_simd_3same_int(s, insn);
7279
 
        break;
7280
 
    }
7281
 
}
7282
 
 
7283
 
/* C3.6.17 AdvSIMD two reg misc
7284
 
 *   31  30  29 28       24 23  22 21       17 16    12 11 10 9    5 4    0
7285
 
 * +---+---+---+-----------+------+-----------+--------+-----+------+------+
7286
 
 * | 0 | Q | U | 0 1 1 1 0 | size | 1 0 0 0 0 | opcode | 1 0 |  Rn  |  Rd  |
7287
 
 * +---+---+---+-----------+------+-----------+--------+-----+------+------+
7288
 
 */
7289
 
static void disas_simd_two_reg_misc(DisasContext *s, uint32_t insn)
7290
 
{
7291
 
    unsupported_encoding(s, insn);
7292
 
}
7293
 
 
7294
 
/* C3.6.18 AdvSIMD vector x indexed element
7295
 
 *   31  30  29 28       24 23  22 21  20  19  16 15 12  11  10 9    5 4    0
7296
 
 * +---+---+---+-----------+------+---+---+------+-----+---+---+------+------+
7297
 
 * | 0 | Q | U | 0 1 1 1 1 | size | L | M |  Rm  | opc | H | 0 |  Rn  |  Rd  |
7298
 
 * +---+---+---+-----------+------+---+---+------+-----+---+---+------+------+
7299
 
 */
7300
 
static void disas_simd_indexed_vector(DisasContext *s, uint32_t insn)
7301
 
{
7302
 
    unsupported_encoding(s, insn);
7303
 
}
7304
 
 
7305
 
/* C3.6.19 Crypto AES
7306
 
 *  31             24 23  22 21       17 16    12 11 10 9    5 4    0
7307
 
 * +-----------------+------+-----------+--------+-----+------+------+
7308
 
 * | 0 1 0 0 1 1 1 0 | size | 1 0 1 0 0 | opcode | 1 0 |  Rn  |  Rd  |
7309
 
 * +-----------------+------+-----------+--------+-----+------+------+
7310
 
 */
7311
 
static void disas_crypto_aes(DisasContext *s, uint32_t insn)
7312
 
{
7313
 
    unsupported_encoding(s, insn);
7314
 
}
7315
 
 
7316
 
/* C3.6.20 Crypto three-reg SHA
7317
 
 *  31             24 23  22  21 20  16  15 14    12 11 10 9    5 4    0
7318
 
 * +-----------------+------+---+------+---+--------+-----+------+------+
7319
 
 * | 0 1 0 1 1 1 1 0 | size | 0 |  Rm  | 0 | opcode | 0 0 |  Rn  |  Rd  |
7320
 
 * +-----------------+------+---+------+---+--------+-----+------+------+
7321
 
 */
7322
 
static void disas_crypto_three_reg_sha(DisasContext *s, uint32_t insn)
7323
 
{
7324
 
    unsupported_encoding(s, insn);
7325
 
}
7326
 
 
7327
 
/* C3.6.21 Crypto two-reg SHA
7328
 
 *  31             24 23  22 21       17 16    12 11 10 9    5 4    0
7329
 
 * +-----------------+------+-----------+--------+-----+------+------+
7330
 
 * | 0 1 0 1 1 1 1 0 | size | 1 0 1 0 0 | opcode | 1 0 |  Rn  |  Rd  |
7331
 
 * +-----------------+------+-----------+--------+-----+------+------+
7332
 
 */
7333
 
static void disas_crypto_two_reg_sha(DisasContext *s, uint32_t insn)
7334
 
{
7335
 
    unsupported_encoding(s, insn);
7336
 
}
7337
 
 
7338
 
/* C3.6 Data processing - SIMD, inc Crypto
7339
 
 *
7340
 
 * As the decode gets a little complex we are using a table based
7341
 
 * approach for this part of the decode.
7342
 
 */
7343
 
static const AArch64DecodeTable data_proc_simd[] = {
7344
 
    /* pattern  ,  mask     ,  fn                        */
7345
 
    { 0x0e200400, 0x9f200400, disas_simd_three_reg_same },
7346
 
    { 0x0e200000, 0x9f200c00, disas_simd_three_reg_diff },
7347
 
    { 0x0e200800, 0x9f3e0c00, disas_simd_two_reg_misc },
7348
 
    { 0x0e300800, 0x9f3e0c00, disas_simd_across_lanes },
7349
 
    { 0x0e000400, 0x9fe08400, disas_simd_copy },
7350
 
    { 0x0f000000, 0x9f000400, disas_simd_indexed_vector },
7351
 
    /* simd_mod_imm decode is a subset of simd_shift_imm, so must precede it */
7352
 
    { 0x0f000400, 0x9ff80400, disas_simd_mod_imm },
7353
 
    { 0x0f000400, 0x9f800400, disas_simd_shift_imm },
7354
 
    { 0x0e000000, 0xbf208c00, disas_simd_tb },
7355
 
    { 0x0e000800, 0xbf208c00, disas_simd_zip_trn },
7356
 
    { 0x2e000000, 0xbf208400, disas_simd_ext },
7357
 
    { 0x5e200400, 0xdf200400, disas_simd_scalar_three_reg_same },
7358
 
    { 0x5e200000, 0xdf200c00, disas_simd_scalar_three_reg_diff },
7359
 
    { 0x5e200800, 0xdf3e0c00, disas_simd_scalar_two_reg_misc },
7360
 
    { 0x5e300800, 0xdf3e0c00, disas_simd_scalar_pairwise },
7361
 
    { 0x5e000400, 0xdfe08400, disas_simd_scalar_copy },
7362
 
    { 0x5f000000, 0xdf000400, disas_simd_scalar_indexed },
7363
 
    { 0x5f000400, 0xdf800400, disas_simd_scalar_shift_imm },
7364
 
    { 0x4e280800, 0xff3e0c00, disas_crypto_aes },
7365
 
    { 0x5e000000, 0xff208c00, disas_crypto_three_reg_sha },
7366
 
    { 0x5e280800, 0xff3e0c00, disas_crypto_two_reg_sha },
7367
 
    { 0x00000000, 0x00000000, NULL }
7368
 
};
7369
 
 
7370
 
static void disas_data_proc_simd(DisasContext *s, uint32_t insn)
7371
 
{
7372
 
    /* Note that this is called with all non-FP cases from
7373
 
     * table C3-6 so it must UNDEF for entries not specifically
7374
 
     * allocated to instructions in that table.
7375
 
     */
7376
 
    AArch64DecodeFn *fn = lookup_disas_fn(&data_proc_simd[0], insn);
7377
 
    if (fn) {
7378
 
        fn(s, insn);
7379
 
    } else {
7380
 
        unallocated_encoding(s);
7381
 
    }
7382
 
}
7383
 
 
7384
 
/* C3.6 Data processing - SIMD and floating point */
7385
 
static void disas_data_proc_simd_fp(DisasContext *s, uint32_t insn)
7386
 
{
7387
 
    if (extract32(insn, 28, 1) == 1 && extract32(insn, 30, 1) == 0) {
7388
 
        disas_data_proc_fp(s, insn);
7389
 
    } else {
7390
 
        /* SIMD, including crypto */
7391
 
        disas_data_proc_simd(s, insn);
7392
 
    }
7393
 
}
7394
 
 
7395
 
/* C3.1 A64 instruction index by encoding */
7396
 
static void disas_a64_insn(CPUARMState *env, DisasContext *s)
7397
 
{
7398
 
    uint32_t insn;
7399
 
 
7400
 
    insn = arm_ldl_code(env, s->pc, s->bswap_code);
7401
 
    s->insn = insn;
7402
 
    s->pc += 4;
7403
 
 
7404
 
    switch (extract32(insn, 25, 4)) {
7405
 
    case 0x0: case 0x1: case 0x2: case 0x3: /* UNALLOCATED */
7406
 
        unallocated_encoding(s);
7407
 
        break;
7408
 
    case 0x8: case 0x9: /* Data processing - immediate */
7409
 
        disas_data_proc_imm(s, insn);
7410
 
        break;
7411
 
    case 0xa: case 0xb: /* Branch, exception generation and system insns */
7412
 
        disas_b_exc_sys(s, insn);
7413
 
        break;
7414
 
    case 0x4:
7415
 
    case 0x6:
7416
 
    case 0xc:
7417
 
    case 0xe:      /* Loads and stores */
7418
 
        disas_ldst(s, insn);
7419
 
        break;
7420
 
    case 0x5:
7421
 
    case 0xd:      /* Data processing - register */
7422
 
        disas_data_proc_reg(s, insn);
7423
 
        break;
7424
 
    case 0x7:
7425
 
    case 0xf:      /* Data processing - SIMD and floating point */
7426
 
        disas_data_proc_simd_fp(s, insn);
7427
 
        break;
7428
 
    default:
7429
 
        assert(FALSE); /* all 15 cases should be handled above */
7430
 
        break;
7431
 
    }
7432
 
 
7433
 
    /* if we allocated any temporaries, free them here */
7434
 
    free_tmp_a64(s);
7435
 
}
7436
 
 
7437
 
void gen_intermediate_code_internal_a64(ARMCPU *cpu,
7438
 
                                        TranslationBlock *tb,
7439
 
                                        bool search_pc)
7440
 
{
7441
 
    CPUState *cs = CPU(cpu);
7442
 
    CPUARMState *env = &cpu->env;
7443
 
    DisasContext dc1, *dc = &dc1;
7444
 
    CPUBreakpoint *bp;
7445
 
    uint16_t *gen_opc_end;
7446
 
    int j, lj;
7447
 
    target_ulong pc_start;
7448
 
    target_ulong next_page_start;
7449
 
    int num_insns;
7450
 
    int max_insns;
7451
 
 
7452
 
    pc_start = tb->pc;
7453
 
 
7454
 
    dc->tb = tb;
7455
 
 
7456
 
    gen_opc_end = tcg_ctx.gen_opc_buf + OPC_MAX_SIZE;
7457
 
 
7458
 
    dc->is_jmp = DISAS_NEXT;
7459
 
    dc->pc = pc_start;
7460
 
    dc->singlestep_enabled = cs->singlestep_enabled;
7461
 
    dc->condjmp = 0;
7462
 
 
7463
 
    dc->aarch64 = 1;
7464
 
    dc->thumb = 0;
7465
 
    dc->bswap_code = 0;
7466
 
    dc->condexec_mask = 0;
7467
 
    dc->condexec_cond = 0;
7468
 
#if !defined(CONFIG_USER_ONLY)
7469
 
    dc->user = 0;
7470
 
#endif
7471
 
    dc->vfp_enabled = 0;
7472
 
    dc->vec_len = 0;
7473
 
    dc->vec_stride = 0;
7474
 
    dc->cp_regs = cpu->cp_regs;
7475
 
    dc->current_pl = arm_current_pl(env);
7476
 
 
7477
 
    init_tmp_a64_array(dc);
7478
 
 
7479
 
    next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
7480
 
    lj = -1;
7481
 
    num_insns = 0;
7482
 
    max_insns = tb->cflags & CF_COUNT_MASK;
7483
 
    if (max_insns == 0) {
7484
 
        max_insns = CF_COUNT_MASK;
7485
 
    }
7486
 
 
7487
 
    gen_tb_start();
7488
 
 
7489
 
    tcg_clear_temp_count();
7490
 
 
7491
 
    do {
7492
 
        if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
7493
 
            QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
7494
 
                if (bp->pc == dc->pc) {
7495
 
                    gen_exception_insn(dc, 0, EXCP_DEBUG);
7496
 
                    /* Advance PC so that clearing the breakpoint will
7497
 
                       invalidate this TB.  */
7498
 
                    dc->pc += 2;
7499
 
                    goto done_generating;
7500
 
                }
7501
 
            }
7502
 
        }
7503
 
 
7504
 
        if (search_pc) {
7505
 
            j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
7506
 
            if (lj < j) {
7507
 
                lj++;
7508
 
                while (lj < j) {
7509
 
                    tcg_ctx.gen_opc_instr_start[lj++] = 0;
7510
 
                }
7511
 
            }
7512
 
            tcg_ctx.gen_opc_pc[lj] = dc->pc;
7513
 
            tcg_ctx.gen_opc_instr_start[lj] = 1;
7514
 
            tcg_ctx.gen_opc_icount[lj] = num_insns;
7515
 
        }
7516
 
 
7517
 
        if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO)) {
7518
 
            gen_io_start();
7519
 
        }
7520
 
 
7521
 
        if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP | CPU_LOG_TB_OP_OPT))) {
7522
 
            tcg_gen_debug_insn_start(dc->pc);
7523
 
        }
7524
 
 
7525
 
        disas_a64_insn(env, dc);
7526
 
 
7527
 
        if (tcg_check_temp_count()) {
7528
 
            fprintf(stderr, "TCG temporary leak before "TARGET_FMT_lx"\n",
7529
 
                    dc->pc);
7530
 
        }
7531
 
 
7532
 
        /* Translation stops when a conditional branch is encountered.
7533
 
         * Otherwise the subsequent code could get translated several times.
7534
 
         * Also stop translation when a page boundary is reached.  This
7535
 
         * ensures prefetch aborts occur at the right place.
7536
 
         */
7537
 
        num_insns++;
7538
 
    } while (!dc->is_jmp && tcg_ctx.gen_opc_ptr < gen_opc_end &&
7539
 
             !cs->singlestep_enabled &&
7540
 
             !singlestep &&
7541
 
             dc->pc < next_page_start &&
7542
 
             num_insns < max_insns);
7543
 
 
7544
 
    if (tb->cflags & CF_LAST_IO) {
7545
 
        gen_io_end();
7546
 
    }
7547
 
 
7548
 
    if (unlikely(cs->singlestep_enabled) && dc->is_jmp != DISAS_EXC) {
7549
 
        /* Note that this means single stepping WFI doesn't halt the CPU.
7550
 
         * For conditional branch insns this is harmless unreachable code as
7551
 
         * gen_goto_tb() has already handled emitting the debug exception
7552
 
         * (and thus a tb-jump is not possible when singlestepping).
7553
 
         */
7554
 
        assert(dc->is_jmp != DISAS_TB_JUMP);
7555
 
        if (dc->is_jmp != DISAS_JUMP) {
7556
 
            gen_a64_set_pc_im(dc->pc);
7557
 
        }
7558
 
        gen_exception(EXCP_DEBUG);
7559
 
    } else {
7560
 
        switch (dc->is_jmp) {
7561
 
        case DISAS_NEXT:
7562
 
            gen_goto_tb(dc, 1, dc->pc);
7563
 
            break;
7564
 
        default:
7565
 
        case DISAS_UPDATE:
7566
 
            gen_a64_set_pc_im(dc->pc);
7567
 
            /* fall through */
7568
 
        case DISAS_JUMP:
7569
 
            /* indicate that the hash table must be used to find the next TB */
7570
 
            tcg_gen_exit_tb(0);
7571
 
            break;
7572
 
        case DISAS_TB_JUMP:
7573
 
        case DISAS_EXC:
7574
 
        case DISAS_SWI:
7575
 
            break;
7576
 
        case DISAS_WFI:
7577
 
            /* This is a special case because we don't want to just halt the CPU
7578
 
             * if trying to debug across a WFI.
7579
 
             */
7580
 
            gen_helper_wfi(cpu_env);
7581
 
            break;
7582
 
        }
7583
 
    }
7584
 
 
7585
 
done_generating:
7586
 
    gen_tb_end(tb, num_insns);
7587
 
    *tcg_ctx.gen_opc_ptr = INDEX_op_end;
7588
 
 
7589
 
#ifdef DEBUG_DISAS
7590
 
    if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
7591
 
        qemu_log("----------------\n");
7592
 
        qemu_log("IN: %s\n", lookup_symbol(pc_start));
7593
 
        log_target_disas(env, pc_start, dc->pc - pc_start,
7594
 
                         dc->thumb | (dc->bswap_code << 1));
7595
 
        qemu_log("\n");
7596
 
    }
7597
 
#endif
7598
 
    if (search_pc) {
7599
 
        j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
7600
 
        lj++;
7601
 
        while (lj <= j) {
7602
 
            tcg_ctx.gen_opc_instr_start[lj++] = 0;
7603
 
        }
7604
 
    } else {
7605
 
        tb->size = dc->pc - pc_start;
7606
 
        tb->icount = num_insns;
7607
 
    }
7608
 
}