blob: 1e2416c5f441cf58c6812592fa8e07a4a92e591d [file] [log] [blame]
Alexander Graf14ade102013-09-03 20:12:10 +01001/*
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
Peter Maydell089a8d92013-12-03 15:26:18 +000031#include "exec/gen-icount.h"
32
Alexander Graf14ade102013-09-03 20:12:10 +010033#include "helper.h"
34#define GEN_HELPER 1
35#include "helper.h"
36
Alex Bennéecee6c332013-11-28 10:16:07 +000037#define DEBUG_AARCH64_DISAS // define to enable tracing
38#ifdef DEBUG_AARCH64_DISAS
39#define TRACE_DECODE(size, opc, opt) \
40 do { \
41 fprintf(stderr, "%s: 0x%08x @ %" HWADDR_PRIx \
42 " with size:%d, opc:%d, opt:%d\n", \
43 __func__, insn, s->pc -4, size, opc, opt); \
44 } while (0);
45#else
46#define TRACE_DECODE(size, opc, opt) do { /* nothing */ } while (0);
47#endif
48
Alexander Graf14ade102013-09-03 20:12:10 +010049static TCGv_i64 cpu_X[32];
50static TCGv_i64 cpu_pc;
Claudio Fontanad41620e2013-12-03 15:12:19 +000051static TCGv_i32 cpu_NF, cpu_ZF, cpu_CF, cpu_VF;
Alexander Graf14ade102013-09-03 20:12:10 +010052
53static const char *regnames[] = {
54 "x0", "x1", "x2", "x3", "x4", "x5", "x6", "x7",
55 "x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
56 "x16", "x17", "x18", "x19", "x20", "x21", "x22", "x23",
57 "x24", "x25", "x26", "x27", "x28", "x29", "lr", "sp"
58};
59
Claudio Fontanad41620e2013-12-03 15:12:19 +000060enum a64_shift_type {
61 A64_SHIFT_TYPE_LSL = 0,
62 A64_SHIFT_TYPE_LSR = 1,
63 A64_SHIFT_TYPE_ASR = 2,
64 A64_SHIFT_TYPE_ROR = 3
65};
66
Alexander Graf14ade102013-09-03 20:12:10 +010067/* initialize TCG globals. */
68void a64_translate_init(void)
69{
70 int i;
71
72 cpu_pc = tcg_global_mem_new_i64(TCG_AREG0,
73 offsetof(CPUARMState, pc),
74 "pc");
75 for (i = 0; i < 32; i++) {
76 cpu_X[i] = tcg_global_mem_new_i64(TCG_AREG0,
77 offsetof(CPUARMState, xregs[i]),
78 regnames[i]);
79 }
80
Claudio Fontanad41620e2013-12-03 15:12:19 +000081 cpu_NF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, NF), "NF");
82 cpu_ZF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, ZF), "ZF");
83 cpu_CF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, CF), "CF");
84 cpu_VF = tcg_global_mem_new_i32(TCG_AREG0, offsetof(CPUARMState, VF), "VF");
Alexander Graf14ade102013-09-03 20:12:10 +010085}
86
87void aarch64_cpu_dump_state(CPUState *cs, FILE *f,
88 fprintf_function cpu_fprintf, int flags)
89{
90 ARMCPU *cpu = ARM_CPU(cs);
91 CPUARMState *env = &cpu->env;
Peter Maydell6cd096b2013-11-26 17:21:48 +000092 uint32_t psr = pstate_read(env);
Alexander Graf14ade102013-09-03 20:12:10 +010093 int i;
94
95 cpu_fprintf(f, "PC=%016"PRIx64" SP=%016"PRIx64"\n",
96 env->pc, env->xregs[31]);
97 for (i = 0; i < 31; i++) {
98 cpu_fprintf(f, "X%02d=%016"PRIx64, i, env->xregs[i]);
99 if ((i % 4) == 3) {
100 cpu_fprintf(f, "\n");
101 } else {
102 cpu_fprintf(f, " ");
103 }
104 }
Peter Maydell6cd096b2013-11-26 17:21:48 +0000105 cpu_fprintf(f, "PSTATE=%08x (flags %c%c%c%c)\n",
106 psr,
107 psr & PSTATE_N ? 'N' : '-',
108 psr & PSTATE_Z ? 'Z' : '-',
109 psr & PSTATE_C ? 'C' : '-',
110 psr & PSTATE_V ? 'V' : '-');
Alexander Graf14ade102013-09-03 20:12:10 +0100111 cpu_fprintf(f, "\n");
112}
113
Alex Bennée871879b2013-11-28 11:18:53 +0000114
115static int get_mem_index(DisasContext *s)
116{
117 /* XXX only user mode for now */
118 return 1;
119}
120
Alexander Graf14ade102013-09-03 20:12:10 +0100121void gen_a64_set_pc_im(uint64_t val)
122{
123 tcg_gen_movi_i64(cpu_pc, val);
124}
125
126static void gen_exception(int excp)
127{
128 TCGv_i32 tmp = tcg_temp_new_i32();
129 tcg_gen_movi_i32(tmp, excp);
130 gen_helper_exception(cpu_env, tmp);
131 tcg_temp_free_i32(tmp);
132}
133
134static void gen_exception_insn(DisasContext *s, int offset, int excp)
135{
136 gen_a64_set_pc_im(s->pc - offset);
137 gen_exception(excp);
Peter Maydell089a8d92013-12-03 15:26:18 +0000138 s->is_jmp = DISAS_EXC;
139}
140
141static inline bool use_goto_tb(DisasContext *s, int n, uint64_t dest)
142{
143 /* No direct tb linking with singlestep or deterministic io */
144 if (s->singlestep_enabled || (s->tb->cflags & CF_LAST_IO)) {
145 return false;
146 }
147
148 /* Only link tbs from inside the same guest page */
149 if ((s->tb->pc & TARGET_PAGE_MASK) != (dest & TARGET_PAGE_MASK)) {
150 return false;
151 }
152
153 return true;
154}
155
156static inline void gen_goto_tb(DisasContext *s, int n, uint64_t dest)
157{
158 TranslationBlock *tb;
159
160 tb = s->tb;
161 if (use_goto_tb(s, n, dest)) {
162 tcg_gen_goto_tb(n);
163 gen_a64_set_pc_im(dest);
164 tcg_gen_exit_tb((tcg_target_long)tb + n);
165 s->is_jmp = DISAS_TB_JUMP;
166 } else {
167 gen_a64_set_pc_im(dest);
168 if (s->singlestep_enabled) {
169 gen_exception(EXCP_DEBUG);
170 }
171 tcg_gen_exit_tb(0);
172 s->is_jmp = DISAS_JUMP;
173 }
Alexander Graf14ade102013-09-03 20:12:10 +0100174}
175
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000176static void unallocated_encoding(DisasContext *s)
Alexander Graf14ade102013-09-03 20:12:10 +0100177{
Alexander Graf14ade102013-09-03 20:12:10 +0100178 gen_exception_insn(s, 4, EXCP_UDEF);
179}
180
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000181#define unsupported_encoding(s, insn) \
182 do { \
183 qemu_log_mask(LOG_UNIMP, \
184 "%s:%d: unsupported instruction encoding 0x%08x " \
185 "at pc=%016" PRIx64 "\n", \
186 __FILE__, __LINE__, insn, s->pc - 4); \
187 unallocated_encoding(s); \
188 } while (0);
Alexander Graf14ade102013-09-03 20:12:10 +0100189
Alexander Grafeeed5002013-12-03 15:12:18 +0000190static void free_tmp_a64(DisasContext *s)
191{
192 int i;
193 for (i = 0; i < s->tmp_a64_count; i++) {
194 tcg_temp_free_i64(s->tmp_a64[i]);
195 }
196 s->tmp_a64_count = 0;
197}
198
199static TCGv_i64 new_tmp_a64_zero(DisasContext *s)
200{
201 assert(s->tmp_a64_count < TMP_A64_MAX);
202 return s->tmp_a64[s->tmp_a64_count++] = tcg_const_i64(0);
203}
204
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000205/*
206 * Register access functions
207 *
208 * These functions are used for directly accessing a register in where
209 * changes to the final register value are likely to be made. If you
210 * need to use a register for temporary calculation (e.g. index type
211 * operations) use the read_* form.
212 *
213 * B1.2.1 Register mappings
214 *
215 * In instruction register encoding 31 can refer to ZR (zero register) or
216 * the SP (stack pointer) depending on context. In QEMUs case we map SP
217 * to cpu_X[31] and ZR accesses to a temporary which can be discarded.
218 * This is the point of the _sp forms.
219 */
Alexander Grafeeed5002013-12-03 15:12:18 +0000220static TCGv_i64 cpu_reg(DisasContext *s, int reg)
221{
222 if (reg == 31) {
223 return new_tmp_a64_zero(s);
224 } else {
225 return cpu_X[reg];
226 }
227}
228
Claudio Fontanab5a339a2013-12-03 15:12:21 +0000229/* register access for when 31 == SP */
230static TCGv_i64 cpu_reg_sp(DisasContext *s, int reg)
231{
232 return cpu_X[reg];
233}
234
Alexander Graf06905b52013-12-03 15:12:19 +0000235/* read a cpu register in 32bit/64bit mode to dst */
236static void read_cpu_reg(DisasContext *s, TCGv_i64 dst, int reg, int sf)
237{
238 if (reg == 31) {
239 tcg_gen_movi_i64(dst, 0);
240 } else if (sf) {
241 tcg_gen_mov_i64(dst, cpu_X[reg]);
242 } else { /* (!sf) */
243 tcg_gen_ext32u_i64(dst, cpu_X[reg]);
244 }
245}
246
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000247static void read_cpu_reg_sp(DisasContext *s, TCGv_i64 dst, int reg, int sf)
248{
249 if (sf) {
250 tcg_gen_mov_i64(dst, cpu_X[reg]);
251 } else { /* (!sf) */
252 tcg_gen_ext32u_i64(dst, cpu_X[reg]);
253 }
254}
255
Claudio Fontanad41620e2013-12-03 15:12:19 +0000256/* this matches the ARM target semantic for flag variables,
257 but it's not optimal for Aarch64. */
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000258
259static inline void gen_set_ZN64(TCGv_i64 result)
260{
261 /* Set ZF and NF based on a 64 bit result. This is alas fiddlier
262 * than the 32 bit equivalent.
263 */
264 TCGv_i64 flag = tcg_temp_new_i64();
265 tcg_gen_setcondi_i64(TCG_COND_NE, flag, result, 0);
266 tcg_gen_trunc_i64_i32(cpu_ZF, flag);
267
268 tcg_gen_shri_i64(flag, result, 32);
269 tcg_gen_trunc_i64_i32(cpu_NF, flag);
270 tcg_temp_free_i64(flag);
271}
272
273/* on !sf result must be passed clean (zero-ext) */
Claudio Fontanad41620e2013-12-03 15:12:19 +0000274static inline void gen_logic_CC(int sf, TCGv_i64 result)
275{
276 if (sf) {
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000277 gen_set_ZN64(result);
Claudio Fontanad41620e2013-12-03 15:12:19 +0000278 } else {
279 tcg_gen_trunc_i64_i32(cpu_ZF, result);
280 tcg_gen_trunc_i64_i32(cpu_NF, result);
281 }
282 tcg_gen_movi_i32(cpu_CF, 0);
283 tcg_gen_movi_i32(cpu_VF, 0);
284}
285
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000286/* dest = T0 + T1; compute C, N, V and Z flags */
287static void gen_add_CC(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
288{
289 if (sf) {
290 TCGv_i64 result, flag, tmp;
291 result = tcg_temp_new_i64();
292 flag = tcg_temp_new_i64();
293 tmp = tcg_temp_new_i64();
294
295 tcg_gen_movi_i64(tmp, 0);
296 tcg_gen_add2_i64(result, flag, t0, tmp, t1, tmp);
297
298 tcg_gen_trunc_i64_i32(cpu_CF, flag);
299
300 gen_set_ZN64(result);
301
302 tcg_gen_xor_i64(flag, result, t0);
303 tcg_gen_xor_i64(tmp, t0, t1);
304 tcg_gen_andc_i64(flag, flag, tmp);
305 tcg_temp_free_i64(tmp);
306 tcg_gen_shri_i64(flag, flag, 32);
307 tcg_gen_trunc_i64_i32(cpu_VF, flag);
308
309 tcg_gen_mov_i64(dest, result);
310 tcg_temp_free_i64(result);
311 tcg_temp_free_i64(flag);
312 } else {
313 /* 32 bit arithmetic */
314 TCGv_i32 t0_32 = tcg_temp_new_i32();
315 TCGv_i32 t1_32 = tcg_temp_new_i32();
316 TCGv_i32 tmp = tcg_temp_new_i32();
317
318 tcg_gen_movi_i32(tmp, 0);
319 tcg_gen_trunc_i64_i32(t0_32, t0);
320 tcg_gen_trunc_i64_i32(t1_32, t1);
321 tcg_gen_add2_i32(cpu_NF, cpu_CF, t0_32, tmp, t1_32, tmp);
322 tcg_gen_mov_i32(cpu_ZF, cpu_NF);
323 tcg_gen_xor_i32(cpu_VF, cpu_NF, t0_32);
324 tcg_gen_xor_i32(tmp, t0_32, t1_32);
325 tcg_gen_andc_i32(cpu_VF, cpu_VF, tmp);
326 tcg_gen_extu_i32_i64(dest, cpu_NF);
327
328 tcg_temp_free_i32(tmp);
329 tcg_temp_free_i32(t0_32);
330 tcg_temp_free_i32(t1_32);
331 }
332}
333
334/* dest = T0 - T1; compute C, N, V and Z flags */
335static void gen_sub_CC(int sf, TCGv_i64 dest, TCGv_i64 t0, TCGv_i64 t1)
336{
337 if (sf) {
338 /* 64 bit arithmetic */
339 TCGv_i64 result, flag, tmp;
340
341 result = tcg_temp_new_i64();
342 flag = tcg_temp_new_i64();
343 tcg_gen_sub_i64(result, t0, t1);
344
345 gen_set_ZN64(result);
346
347 tcg_gen_setcond_i64(TCG_COND_GEU, flag, t0, t1);
348 tcg_gen_trunc_i64_i32(cpu_CF, flag);
349
350 tcg_gen_xor_i64(flag, result, t0);
351 tmp = tcg_temp_new_i64();
352 tcg_gen_xor_i64(tmp, t0, t1);
353 tcg_gen_and_i64(flag, flag, tmp);
354 tcg_temp_free_i64(tmp);
355 tcg_gen_shri_i64(flag, flag, 32);
356 tcg_gen_trunc_i64_i32(cpu_VF, flag);
357 tcg_gen_mov_i64(dest, result);
358 tcg_temp_free_i64(flag);
359 tcg_temp_free_i64(result);
360 } else {
361 /* 32 bit arithmetic */
362 TCGv_i32 t0_32 = tcg_temp_new_i32();
363 TCGv_i32 t1_32 = tcg_temp_new_i32();
364 TCGv_i32 tmp;
365
366 tcg_gen_trunc_i64_i32(t0_32, t0);
367 tcg_gen_trunc_i64_i32(t1_32, t1);
368 tcg_gen_sub_i32(cpu_NF, t0_32, t1_32);
369 tcg_gen_mov_i32(cpu_ZF, cpu_NF);
370 tcg_gen_setcond_i32(TCG_COND_GEU, cpu_CF, t0_32, t1_32);
371 tcg_gen_xor_i32(cpu_VF, cpu_NF, t0_32);
372 tmp = tcg_temp_new_i32();
373 tcg_gen_xor_i32(tmp, t0_32, t1_32);
374 tcg_temp_free_i32(t0_32);
375 tcg_temp_free_i32(t1_32);
376 tcg_gen_and_i32(cpu_VF, cpu_VF, tmp);
377 tcg_temp_free_i32(tmp);
378 tcg_gen_extu_i32_i64(dest, cpu_NF);
379 }
380}
381
Claudio Fontana422426c2013-12-03 15:12:21 +0000382enum sysreg_access {
383 SYSTEM_GET,
384 SYSTEM_PUT
385};
386
387/* C4.3.10 - NZVC */
388static int get_nzcv(TCGv_i64 tcg_rt)
389{
390 TCGv_i32 nzcv, tmp;
391 tmp = tcg_temp_new_i32();
392 nzcv = tcg_temp_new_i32();
393
394 /* build bit 31, N */
395 tcg_gen_andi_i32(nzcv, cpu_NF, (1 << 31));
396 /* build bit 30, Z */
397 tcg_gen_setcondi_i32(TCG_COND_EQ, tmp, cpu_ZF, 0);
398 tcg_gen_deposit_i32(nzcv, nzcv, tmp, 30, 1);
399 /* build bit 29, C */
400 tcg_gen_deposit_i32(nzcv, nzcv, cpu_CF, 29, 1);
401 /* build bit 28, V */
402 tcg_gen_shri_i32(tmp, cpu_VF, 31);
403 tcg_gen_deposit_i32(nzcv, nzcv, tmp, 28, 1);
404 /* generate result */
405 tcg_gen_extu_i32_i64(tcg_rt, nzcv);
406
407 tcg_temp_free_i32(nzcv);
408 tcg_temp_free_i32(tmp);
409 return 0;
410}
411
412static int put_nzcv(TCGv_i64 tcg_rt)
413{
414 TCGv_i32 nzcv;
415 nzcv = tcg_temp_new_i32();
416
417 /* take NZCV from R[t] */
418 tcg_gen_trunc_i64_i32(nzcv, tcg_rt);
419
420 /* bit 31, N */
421 tcg_gen_andi_i32(cpu_NF, nzcv, (1 << 31));
422 /* bit 30, Z */
423 tcg_gen_andi_i32(cpu_ZF, nzcv, (1 << 30));
424 tcg_gen_setcondi_i32(TCG_COND_EQ, cpu_ZF, cpu_ZF, 0);
425 /* bit 29, C */
426 tcg_gen_andi_i32(cpu_CF, nzcv, (1 << 29));
427 tcg_gen_shri_i32(cpu_CF, cpu_CF, 29);
428 /* bit 28, V */
429 tcg_gen_andi_i32(cpu_VF, nzcv, (1 << 28));
430 tcg_gen_shli_i32(cpu_VF, cpu_VF, 3); /* shift to position 31 */
431
432 tcg_temp_free_i32(nzcv);
433 return 0;
434}
435
436/* CTR_EL0 (D8.2.21) */
437static int get_ctr_el0(TCGv_i64 tcg_rt)
438{
439 tcg_gen_movi_i64(tcg_rt, 0x80030003);
440 return 0;
441}
442
443/* DCZID_EL0 (D8.2.23) */
444static int get_dczid_el0(TCGv_i64 tcg_rt)
445{
446 tcg_gen_movi_i64(tcg_rt, 0x10);
447 return 0;
448}
449
450/* TPIDR_EL0 (D8.2.87) */
451static int get_tpidr_el0(TCGv_i64 tcg_rt)
452{
453 tcg_gen_ld_i64(tcg_rt, cpu_env,
454 offsetof(CPUARMState, sr.tpidr_el0));
455 return 0;
456}
457
458static int put_tpidr_el0(TCGv_i64 tcg_rt)
459{
460 tcg_gen_st_i64(tcg_rt, cpu_env,
461 offsetof(CPUARMState, sr.tpidr_el0));
462 return 0;
463}
464
Claudio Fontanab1a32b32013-12-03 15:12:22 +0000465/* FPCR (C4.3.9) */
466static int get_fpcr(TCGv_i64 tcg_rt)
467{
468 gen_helper_get_fpcr(tcg_rt, cpu_env);
469 return 0;
470}
471
472static int put_fpcr(TCGv_i64 tcg_rt)
473{
474 gen_helper_set_fpcr(cpu_env, tcg_rt);
475 return 0;
476}
Claudio Fontana422426c2013-12-03 15:12:21 +0000477
478/* manual: System_Get() / System_Put() */
479/* returns 0 on success, 1 on unsupported, 2 on unallocated */
480static int sysreg_access(enum sysreg_access access, DisasContext *s,
481 unsigned int op0, unsigned int op1, unsigned int op2,
482 unsigned int crn, unsigned int crm, unsigned int rt)
483{
484 if (op0 != 3) {
485 return 1; /* we only support non-debug system registers for now */
486 }
487
488 if (crn == 4) {
489 /* Table C4-8 Special-purpose register accesses */
490 if (op1 == 3 && crm == 2 && op2 == 0) {
491 /* NZVC C4.3.10 */
492 return access == SYSTEM_GET ?
493 get_nzcv(cpu_reg(s, rt)) : put_nzcv(cpu_reg(s, rt));
Claudio Fontanab1a32b32013-12-03 15:12:22 +0000494 } else if (op1 == 3 && crm == 4 && op2 == 0) {
495 return access == SYSTEM_GET ?
496 get_fpcr(cpu_reg(s, rt)) : put_fpcr(cpu_reg(s, rt));
Claudio Fontana422426c2013-12-03 15:12:21 +0000497 }
498 } else if (crn == 11 || crn == 15) {
499 /* C4.2.7 Reserved control space for IMPLEM.-DEFINED func. */
500 return 2;
501 } else {
502 /* Table C4-7 System insn encodings for System register access */
503 if (crn == 0 && op1 == 3 && crm == 0 && op2 == 1) {
504 /* CTR_EL0 (D8.2.21) */
505 return access == SYSTEM_GET ? get_ctr_el0(cpu_reg(s, rt)) : 2;
506 } else if (crn == 0 && op1 == 3 && crm == 0 && op2 == 7) {
507 /* DCZID_EL0 (D8.2.23) */
508 return access == SYSTEM_GET ? get_dczid_el0(cpu_reg(s, rt)) : 2;
509 } else if (crn == 13 && op1 == 3 && crm == 0 && op2 == 2) {
510 return access == SYSTEM_GET ?
511 get_tpidr_el0(cpu_reg(s, rt)) : put_tpidr_el0(cpu_reg(s, rt));
512 }
513 }
514
515 return 1; /* unsupported */
516}
517
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000518/*
Alex Bennée871879b2013-11-28 11:18:53 +0000519 * Load/Store generators
520 */
521
522/*
523 Store from GPR Register to Memory
524*/
525static void do_gpr_st(DisasContext *s, TCGv_i64 source, TCGv_i64 tcg_addr, int size)
526{
527 switch (size) {
528 case 0:
529 tcg_gen_qemu_st8(source, tcg_addr, get_mem_index(s));
530 break;
531 case 1:
532 tcg_gen_qemu_st16(source, tcg_addr, get_mem_index(s));
533 break;
534 case 2:
535 tcg_gen_qemu_st32(source, tcg_addr, get_mem_index(s));
536 break;
537 case 3:
538 tcg_gen_qemu_st64(source, tcg_addr, get_mem_index(s));
539 break;
540 default:
541 /* Bad size */
542 g_assert(false);
543 break;
544 }
545}
546
547/*
Alex Bennéeefe92a72013-11-28 11:19:31 +0000548 Load from memory to GPR Register
549*/
550static void do_gpr_ld(DisasContext *s, TCGv_i64 dest, TCGv_i64 tcg_addr, int size, int is_signed)
551{
552 switch (size) {
553 case 0:
554 if (is_signed) {
555 tcg_gen_qemu_ld8s(dest, tcg_addr, get_mem_index(s));
556 } else {
557 tcg_gen_qemu_ld8u(dest, tcg_addr, get_mem_index(s));
558 }
559 break;
560 case 1:
561 if (is_signed) {
562 tcg_gen_qemu_ld16s(dest, tcg_addr, get_mem_index(s));
563 } else {
564 tcg_gen_qemu_ld16u(dest, tcg_addr, get_mem_index(s));
565 }
566 break;
567 case 2:
568 if (is_signed) {
569 tcg_gen_qemu_ld32s(dest, tcg_addr, get_mem_index(s));
570 } else {
571 tcg_gen_qemu_ld32u(dest, tcg_addr, get_mem_index(s));
572 }
573 break;
574 case 3:
575 tcg_gen_qemu_ld64(dest, tcg_addr, get_mem_index(s));
576 break;
577 default:
578 /* Bad size */
579 g_assert(false);
580 break;
581 }
582}
583
584/* Store from FP register to memory */
585static void do_fp_st(DisasContext *s, int srcidx, TCGv_i64 tcg_addr, int size)
586{
587 /* This writes the bottom N bits of a 128 bit wide vector to memory */
588 int freg_offs = offsetof(CPUARMState, vfp.regs[srcidx * 2]);
589 TCGv_i64 tmp = tcg_temp_new_i64();
590
591 switch (size) {
592 case 0:
593 tcg_gen_ld8u_i64(tmp, cpu_env, freg_offs);
594 tcg_gen_qemu_st8(tmp, tcg_addr, get_mem_index(s));
595 break;
596 case 1:
597 tcg_gen_ld16u_i64(tmp, cpu_env, freg_offs);
598 tcg_gen_qemu_st16(tmp, tcg_addr, get_mem_index(s));
599 break;
600 case 2:
601 tcg_gen_ld32u_i64(tmp, cpu_env, freg_offs);
602 tcg_gen_qemu_st32(tmp, tcg_addr, get_mem_index(s));
603 break;
604 case 3:
605 tcg_gen_ld_i64(tmp, cpu_env, freg_offs);
606 tcg_gen_qemu_st64(tmp, tcg_addr, get_mem_index(s));
607 break;
608 case 4:
609 {
610 TCGv_i64 tcg_hiaddr = tcg_temp_new_i64();
611 tcg_gen_ld_i64(tmp, cpu_env, freg_offs);
612 tcg_gen_qemu_st64(tmp, tcg_addr, get_mem_index(s));
613 tcg_gen_ld_i64(tmp, cpu_env, freg_offs = sizeof(float64));
614 tcg_gen_addi_i64(tcg_hiaddr, tcg_addr, 8);
615 tcg_gen_qemu_st64(tmp, tcg_hiaddr, get_mem_index(s));
616 tcg_temp_free_i64(tcg_hiaddr);
617 break;
618 }
619 default:
620 g_assert(false);
621 break;
622 }
623
624 tcg_temp_free_i64(tmp);
625}
626
627/* Load from memory to FP register */
628static void do_fp_ld(DisasContext *s, int destidx, TCGv_i64 tcg_addr, int size)
629{
630 /* This always zero-extends and writes to a full 128 bit wide vector */
631 int freg_offs = offsetof(CPUARMState, vfp.regs[destidx * 2]);
632 TCGv_i64 tmplo = tcg_temp_new_i64();
633 TCGv_i64 tmphi;
634
635 switch (size) {
636 case 0:
637 tcg_gen_qemu_ld8u(tmplo, tcg_addr, get_mem_index(s));
638 break;
639 case 1:
640 tcg_gen_qemu_ld16u(tmplo, tcg_addr, get_mem_index(s));
641 break;
642 case 2:
643 tcg_gen_qemu_ld32u(tmplo, tcg_addr, get_mem_index(s));
644 break;
645 case 3:
646 case 4:
647 tcg_gen_qemu_ld64(tmplo, tcg_addr, get_mem_index(s));
648 break;
649 default:
650 g_assert(false);
651 break;
652 }
653
654 switch (size) {
655 case 4:
656 {
657 TCGv_i64 tcg_hiaddr;
658
659 tmphi = tcg_temp_new_i64();
660 tcg_hiaddr = tcg_temp_new_i64();
661 tcg_gen_addi_i64(tcg_hiaddr, tcg_addr, 8);
662 tcg_gen_qemu_ld64(tmphi, tcg_hiaddr, get_mem_index(s));
663 tcg_temp_free_i64(tcg_hiaddr);
664 break;
665 }
666 default:
667 tmphi = tcg_const_i64(0);
668 break;
669 }
670
671 tcg_gen_st_i64(tmplo, cpu_env, freg_offs);
672 tcg_gen_st_i64(tmphi, cpu_env, freg_offs + sizeof(float64));
673
674 tcg_temp_free_i64(tmplo);
675 tcg_temp_free_i64(tmphi);
676}
677
678/*
Alex Bennéeffb7dab2013-12-03 10:52:22 +0000679 * This utility function is for doing register extension with an
680 * optional shift. You will likely want to pass a temporary for the
681 * destination register. See DecodeRegExtend() in the aarch64 manual
682 */
683
684static void ext_and_shift_reg(TCGv_i64 tcg_out, TCGv_i64 tcg_in,
685 int option, int shift)
686{
687 int extsize = extract32(option, 0, 2);
688 bool is_signed = extract32(option, 2, 1);
689
690 if (is_signed) {
691 switch (extsize) {
692 case 0:
693 tcg_gen_ext8s_i64(tcg_out, tcg_in);
694 break;
695 case 1:
696 tcg_gen_ext16s_i64(tcg_out, tcg_in);
697 break;
698 case 2:
699 tcg_gen_ext32s_i64(tcg_out, tcg_in);
700 break;
701 case 3:
702 tcg_gen_mov_i64(tcg_out, tcg_in);
703 break;
704 }
705 } else {
706 switch (extsize) {
707 case 0:
708 tcg_gen_ext8u_i64(tcg_out, tcg_in);
709 break;
710 case 1:
711 tcg_gen_ext16u_i64(tcg_out, tcg_in);
712 break;
713 case 2:
714 tcg_gen_ext32u_i64(tcg_out, tcg_in);
715 break;
716 case 3:
717 tcg_gen_mov_i64(tcg_out, tcg_in);
718 break;
719 }
720 }
721
722 if (shift) {
723 tcg_gen_shli_i64(tcg_out, tcg_out, shift);
724 }
725}
726
727/*
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000728 * the instruction disassembly implemented here matches
729 * the instruction encoding classifications in chapter 3 (C3)
730 * of the ARM Architecture Reference Manual (DDI0487A_a)
731 */
732
Alexander Grafeeed5002013-12-03 15:12:18 +0000733/* C3.2.7 Unconditional branch (immediate)
734 * 31 30 26 25 0
735 * +----+-----------+-------------------------------------+
736 * | op | 0 0 1 0 1 | imm26 |
737 * +----+-----------+-------------------------------------+
738 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000739static void disas_uncond_b_imm(DisasContext *s, uint32_t insn)
740{
Alexander Grafeeed5002013-12-03 15:12:18 +0000741 uint64_t addr = s->pc + sextract32(insn, 0, 26) * 4 - 4;
742
743 if (insn & (1 << 31)) {
744 /* C5.6.26 BL Branch with link */
745 tcg_gen_movi_i64(cpu_reg(s, 30), s->pc);
746 }
747
748 /* C5.6.20 B Branch / C5.6.26 BL Branch with link */
749 gen_goto_tb(s, 0, addr);
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000750}
751
Alexander Graf06905b52013-12-03 15:12:19 +0000752/* C3.2.1 Compare & branch (immediate)
753 * 31 30 25 24 23 5 4 0
754 * +----+-------------+----+---------------------+--------+
755 * | sf | 0 1 1 0 1 0 | op | imm19 | Rt |
756 * +----+-------------+----+---------------------+--------+
757 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000758static void disas_comp_b_imm(DisasContext *s, uint32_t insn)
759{
Alexander Graf06905b52013-12-03 15:12:19 +0000760 unsigned int sf, op, rt;
761 uint64_t addr;
762 int label_nomatch;
763 TCGv_i64 tcg_cmp;
764
765 sf = extract32(insn, 31, 1);
766 op = extract32(insn, 24, 1);
767 rt = extract32(insn, 0, 5);
768 addr = s->pc + sextract32(insn, 5, 19) * 4 - 4;
769
770 tcg_cmp = tcg_temp_new_i64();
771 read_cpu_reg(s, tcg_cmp, rt, sf);
772 label_nomatch = gen_new_label();
773
774 if (op) { /* CBNZ */
775 tcg_gen_brcondi_i64(TCG_COND_EQ, tcg_cmp, 0, label_nomatch);
776 } else { /* CBZ */
777 tcg_gen_brcondi_i64(TCG_COND_NE, tcg_cmp, 0, label_nomatch);
778 }
779
780 tcg_temp_free_i64(tcg_cmp);
781
782 gen_goto_tb(s, 0, addr);
783 gen_set_label(label_nomatch);
784 gen_goto_tb(s, 1, s->pc);
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000785}
786
Alexander Grafee52d8c2013-12-03 15:12:19 +0000787/* C3.2.5 Test & branch (immediate)
788 * 31 30 25 24 23 19 18 5 4 0
789 * +----+-------------+----+-------+-------------+------+
790 * | b5 | 0 1 1 0 1 1 | op | b40 | imm14 | Rt |
791 * +----+-------------+----+-------+-------------+------+
792 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000793static void disas_test_b_imm(DisasContext *s, uint32_t insn)
794{
Alexander Grafee52d8c2013-12-03 15:12:19 +0000795 unsigned int bit_pos, op, rt;
796 uint64_t addr;
797 int label_nomatch;
798 TCGv_i64 tcg_cmp;
799
800 bit_pos = (extract32(insn, 31, 1) << 5) | extract32(insn, 19, 5);
801 op = extract32(insn, 24, 1);
802 addr = s->pc + sextract32(insn, 5, 14) * 4 - 4;
803 rt = extract32(insn, 0, 5);
804
805 tcg_cmp = tcg_temp_new_i64();
806 tcg_gen_andi_i64(tcg_cmp, cpu_reg(s, rt), (1ULL << bit_pos));
807 label_nomatch = gen_new_label();
808 if (op) { /* TBNZ */
809 tcg_gen_brcondi_i64(TCG_COND_EQ, tcg_cmp, 0, label_nomatch);
810 } else { /* TBZ */
811 tcg_gen_brcondi_i64(TCG_COND_NE, tcg_cmp, 0, label_nomatch);
812 }
813 tcg_temp_free_i64(tcg_cmp);
814 gen_goto_tb(s, 0, addr);
815 gen_set_label(label_nomatch);
816 gen_goto_tb(s, 1, s->pc);
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000817}
818
Alexander Grafd0deb6c2013-12-03 15:12:18 +0000819/* C3.2.2 / C5.6.19 Conditional branch (immediate)
820 * 31 25 24 23 5 4 3 0
821 * +---------------+----+---------------------+----+------+
822 * | 0 1 0 1 0 1 0 | o1 | imm19 | o0 | cond |
823 * +---------------+----+---------------------+----+------+
824 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000825static void disas_cond_b_imm(DisasContext *s, uint32_t insn)
826{
Alexander Grafd0deb6c2013-12-03 15:12:18 +0000827 unsigned int cond;
828 uint64_t addr;
829
830 if ((insn & (1 << 4)) || (insn & (1 << 24))) {
831 unallocated_encoding(s);
832 return;
833 }
834 addr = s->pc + sextract32(insn, 5, 19) * 4 - 4;
835 cond = extract32(insn, 0, 4);
836
837 if (cond < 0x0e) {
838 /* genuinely conditional branches */
839 int label_nomatch = gen_new_label();
840 arm_gen_test_cc(cond ^ 1, label_nomatch);
841 gen_goto_tb(s, 0, addr);
842 gen_set_label(label_nomatch);
843 gen_goto_tb(s, 1, s->pc);
844 } else {
845 /* 0xe and 0xf are both "always" conditions */
846 gen_goto_tb(s, 0, addr);
847 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000848}
849
Claudio Fontana20b3f312013-12-03 15:12:18 +0000850/* C5.6.68 HINT */
851static void handle_hint(DisasContext *s, uint32_t insn,
852 unsigned int op1, unsigned int op2, unsigned int crm)
853{
854 unsigned int selector = crm << 3 | op2;
855
856 if (op1 != 3) {
857 unallocated_encoding(s);
858 return;
859 }
860
861 switch (selector) {
862 case 0: /* NOP */
863 return;
864 case 1: /* YIELD */
865 case 2: /* WFE */
866 case 3: /* WFI */
867 case 4: /* SEV */
868 case 5: /* SEVL */
869 /* we treat all as NOP at least for now */
870 return;
871 default:
872 /* default specified as NOP equivalent */
873 return;
874 }
875}
876
877/* CLREX, DSB, DMB, ISB */
878static void handle_sync(DisasContext *s, uint32_t insn,
879 unsigned int op1, unsigned int op2, unsigned int crm)
880{
881 if (op1 != 3) {
882 unallocated_encoding(s);
883 return;
884 }
885
886 switch (op2) {
887 case 2: /* CLREX */
888 unsupported_encoding(s, insn);
889 return;
890 case 4: /* DSB */
891 case 5: /* DMB */
892 case 6: /* ISB */
893 /* We don't emulate caches so barriers are no-ops */
894 return;
895 default:
896 unallocated_encoding(s);
897 return;
898 }
899}
900
901/* C5.6.130 MSR (immediate) - move immediate to processor state field */
902static void handle_msr_i(DisasContext *s, uint32_t insn,
903 unsigned int op1, unsigned int op2, unsigned int crm)
Claudio Fontanaea5ca532013-12-03 15:12:18 +0000904{
905 unsupported_encoding(s, insn);
906}
907
Claudio Fontana20b3f312013-12-03 15:12:18 +0000908/* C5.6.204 SYS */
909static void handle_sys(DisasContext *s, uint32_t insn, unsigned int l,
910 unsigned int op1, unsigned int op2,
911 unsigned int crn, unsigned int crm, unsigned int rt)
912{
913 unsupported_encoding(s, insn);
914}
915
916/* C5.6.129 MRS - move from system register */
917static void handle_mrs(DisasContext *s, uint32_t insn, unsigned int op0,
918 unsigned int op1, unsigned int op2,
919 unsigned int crn, unsigned int crm, unsigned int rt)
920{
Claudio Fontana422426c2013-12-03 15:12:21 +0000921 int rv = sysreg_access(SYSTEM_GET, s, op0, op1, op2, crn, crm, rt);
922
923 switch (rv) {
924 case 0:
925 return;
926 case 1: /* unsupported */
927 unsupported_encoding(s, insn);
928 break;
929 case 2: /* unallocated */
930 unallocated_encoding(s);
931 break;
932 default:
933 assert(FALSE);
934 }
935
936 qemu_log("MRS: [op0=%d,op1=%d,op2=%d,crn=%d,crm=%d]\n",
937 op0, op1, op2, crn, crm);
Claudio Fontana20b3f312013-12-03 15:12:18 +0000938}
939
940/* C5.6.131 MSR (register) - move to system register */
941static void handle_msr(DisasContext *s, uint32_t insn, unsigned int op0,
942 unsigned int op1, unsigned int op2,
943 unsigned int crn, unsigned int crm, unsigned int rt)
944{
Claudio Fontana422426c2013-12-03 15:12:21 +0000945 int rv = sysreg_access(SYSTEM_PUT, s, op0, op1, op2, crn, crm, rt);
946
947 switch (rv) {
948 case 0:
949 return;
950 case 1: /* unsupported */
951 unsupported_encoding(s, insn);
952 break;
953 case 2: /* unallocated */
954 unallocated_encoding(s);
955 break;
956 default:
957 assert(FALSE);
958 }
959
960 qemu_log("MSR: [op0=%d,op1=%d,op2=%d,crn=%d,crm=%d]\n",
961 op0, op1, op2, crn, crm);
Claudio Fontana20b3f312013-12-03 15:12:18 +0000962}
963
964/* C3.2.4 System */
965static void disas_system(DisasContext *s, uint32_t insn)
966{
967 /*
968 * 31 30 29 28 27 26 25 24 23 22 21 20 19 18 16 15 12 11 8 7 5 4 0
969 * 1 1 0 1 0 1 0 1 0 0 L op0 op1 CRn CRm op2 Rt
970 */
971 unsigned int l, op0, op1, crn, crm, op2, rt;
972 l = extract32(insn, 21, 1);
973 op0 = extract32(insn, 19, 2);
974 op1 = extract32(insn, 16, 3);
975 crn = extract32(insn, 12, 4);
976 crm = extract32(insn, 8, 4);
977 op2 = extract32(insn, 5, 3);
978 rt = extract32(insn, 0, 5);
979
980 if (op0 == 0) {
981 if (l || rt != 31) {
982 unallocated_encoding(s);
983 return;
984 }
985 switch (crn) {
986 case 2: /* C5.6.68 HINT */
987 handle_hint(s, insn, op1, op2, crm);
988 break;
989 case 3: /* CLREX, DSB, DMB, ISB */
990 handle_sync(s, insn, op1, op2, crm);
991 break;
992 case 4: /* C5.6.130 MSR (immediate) */
993 handle_msr_i(s, insn, op1, op2, crm);
994 break;
995 default:
996 unallocated_encoding(s);
997 break;
998 }
999 return;
1000 }
1001
1002 if (op0 == 1) {
1003 /* C5.6.204 SYS */
1004 handle_sys(s, insn, l, op1, op2, crn, crm, rt);
1005 } else if (l) { /* op0 > 1 */
1006 /* C5.6.129 MRS - move from system register */
1007 handle_mrs(s, insn, op0, op1, op2, crn, crm, rt);
1008 } else {
1009 /* C5.6.131 MSR (register) - move to system register */
1010 handle_msr(s, insn, op0, op1, op2, crn, crm, rt);
1011 }
1012}
1013
Alex Bennée50124452013-11-28 14:04:25 +00001014static void handle_svc(DisasContext *s, uint32_t insn)
1015{
1016 gen_exception_insn(s, 0, EXCP_SWI);
1017}
1018
1019/* C3.2.3 Exception generation
1020
1021 31 24 23 21 20 5 4 2 1 0
1022 +-----------------+-----+------------------------+-----+----+
1023 | 1 1 0 1 0 1 0 0 | opc | imm16 | op2 | LL |
1024 +-----------------------+------------------------+----------+
1025
1026 opc op2 LL
1027 000 000 01 -> SVC
1028 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001029static void disas_exc(DisasContext *s, uint32_t insn)
1030{
Alex Bennée50124452013-11-28 14:04:25 +00001031 int opc = extract32(insn, 21, 3);
1032 int op2_ll = extract32(insn, 0, 5);
1033 int instruction = (opc<<5) | op2_ll;
1034
1035 switch (instruction) {
1036 case 1:
1037 handle_svc(s, insn);
1038 break;
1039 default:
1040 unsupported_encoding(s, insn);
1041 break;
1042 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001043}
1044
Alexander Graf37699832013-12-03 15:12:18 +00001045/* C3.2.7 Unconditional branch (register)
1046 * 31 25 24 21 20 16 15 10 9 5 4 0
1047 * +---------------+-------+-------+-------+------+-------+
1048 * | 1 1 0 1 0 1 1 | opc | op2 | op3 | Rn | op4 |
1049 * +---------------+-------+-------+-------+------+-------+
1050 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001051static void disas_uncond_b_reg(DisasContext *s, uint32_t insn)
1052{
Alexander Graf37699832013-12-03 15:12:18 +00001053 unsigned int opc, op2, op3, rn, op4;
1054
1055 opc = extract32(insn, 21, 4);
1056 op2 = extract32(insn, 16, 5);
1057 op3 = extract32(insn, 10, 6);
1058 rn = extract32(insn, 5, 5);
1059 op4 = extract32(insn, 0, 5);
1060
1061 if (op4 != 0x0 || op3 != 0x0 || op2 != 0x1f) {
1062 unallocated_encoding(s);
1063 return;
1064 }
1065
1066 switch (opc) {
1067 case 0: /* BR */
1068 case 2: /* RET */
1069 break;
1070 case 1: /* BLR */
1071 tcg_gen_movi_i64(cpu_reg(s, 30), s->pc);
1072 break;
1073 case 4: /* ERET */
1074 case 5: /* DRPS */
1075 if (rn != 0x1f) {
1076 unallocated_encoding(s);
1077 } else {
1078 unsupported_encoding(s, insn);
1079 }
1080 return;
1081 default:
1082 unallocated_encoding(s);
1083 return;
1084 }
1085
1086 tcg_gen_mov_i64(cpu_pc, cpu_reg(s, rn));
1087 s->is_jmp = DISAS_JUMP;
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001088}
1089
1090/* C3.2 Branches, exception generating and system instructions */
1091static void disas_b_exc_sys(DisasContext *s, uint32_t insn)
1092{
1093 switch (extract32(insn, 25, 7)) {
1094 case 0x0a: case 0x0b:
1095 case 0x4a: case 0x4b: /* Unconditional branch (immediate) */
1096 disas_uncond_b_imm(s, insn);
1097 break;
1098 case 0x1a: case 0x5a: /* Compare & branch (immediate) */
1099 disas_comp_b_imm(s, insn);
1100 break;
1101 case 0x1b: case 0x5b: /* Test & branch (immediate) */
1102 disas_test_b_imm(s, insn);
1103 break;
1104 case 0x2a: /* Conditional branch (immediate) */
1105 disas_cond_b_imm(s, insn);
1106 break;
1107 case 0x6a: /* Exception generation / System */
1108 if (insn & (1 << 24)) {
1109 disas_system(s, insn);
1110 } else {
1111 disas_exc(s, insn);
1112 }
1113 break;
1114 case 0x6b: /* Unconditional branch (register) */
1115 disas_uncond_b_reg(s, insn);
1116 break;
1117 default:
1118 unallocated_encoding(s);
1119 break;
1120 }
1121}
1122
1123/* Load/store exclusive */
1124static void disas_ldst_excl(DisasContext *s, uint32_t insn)
1125{
1126 unsupported_encoding(s, insn);
1127}
1128
Alex Bennée0d680852013-11-25 14:34:40 +00001129/* C3.3.5 Load register (literal)
1130
1131 31 30 29 27 26 25 24 23 5 4 0
1132 +-----+-------+--+-----+-------------------+-------+
1133 | opc | 0 1 1 |V | 0 0 | imm19 | Rt |
1134 +-----+-------+--+-----+-------------------+-------+
1135
1136 opc: 00 -> 32bit, 01 -> 64bit, 10-> 64bit signed, 11 -> prefetch
1137 V: 1 -> vector (simd/fp)
1138 */
1139static void handle_ld_lit(DisasContext *s, uint32_t insn)
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001140{
Alex Bennée0d680852013-11-25 14:34:40 +00001141 int rt = extract32(insn, 0, 5);
1142 int64_t imm = sextract32(insn, 5, 19) << 2;
1143 bool is_vector = extract32(insn, 26, 1);
1144 int opc = extract32(insn, 30, 2);
1145
1146 TCGv_i64 tcg_rt = cpu_reg(s, rt);
1147 TCGv_i64 tcg_addr;
1148 bool is_signed = false;
1149 int size = 2;
1150
1151 switch (opc) {
1152 case 0:
1153 is_signed = false;
1154 size = 2;
1155 break;
1156 case 1:
1157 is_signed = false;
1158 size = 3;
1159 break;
1160 case 2:
1161 is_signed = true;
1162 size = 2;
1163 break;
1164 case 3:
1165 /* prefetch */
1166 return;
1167 }
1168
1169 if (is_vector) {
1170 unsupported_encoding(s, insn);
1171 } else {
1172 tcg_addr = tcg_const_i64((s->pc - 4) + imm);
1173 do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed);
1174 tcg_temp_free_i64(tcg_addr);
1175 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001176}
1177
Alex Bennée871879b2013-11-28 11:18:53 +00001178/*
Alex Bennée426998f2013-11-28 13:29:40 +00001179 C5.6.81 LDP (Load Pair - non vector)
1180 C5.6.82 LDPSW (Load Pair Signed Word - non vector
1181
1182 31 30 29 26 25 23 22 21 15 14 10 9 5 4 0
1183 +--+--+-----------+-------+--+-----------------------------+
1184 |sf| s| 1 0 1 0 | index | 1| imm7 | Rt2 | Rn | Rt |
1185 +-----+-----------+-------+--+-------+-------+------+------+
1186 L
1187 sf: 0 -> 32bit, 1 -> 64bit
1188 s: 0 -> unsigned, 1 -> signed
1189 idx: 001 -> post-index, 011 -> pre-index, 010 -> signed off
1190
1191*/
1192static void handle_gpr_ldp(DisasContext *s, uint32_t insn)
1193{
1194 int rt = extract32(insn, 0, 5);
1195 int rn = extract32(insn, 5, 5);
1196 int rt2 = extract32(insn, 10, 5);
1197 int64_t offset = sextract32(insn, 15, 7);
1198 int idx = extract32(insn, 23, 3);
1199 int is_signed = extract32(insn, 30, 1);
1200 int sf = extract32(insn, 31, 1);
1201
1202 int size = sf?3:2;
1203 bool postindex = true;
1204 bool wback = false;
1205
1206 TCGv_i64 tcg_rt = cpu_reg(s, rt);
1207 TCGv_i64 tcg_rt2 = cpu_reg(s, rt2);
1208 TCGv_i64 tcg_addr = tcg_temp_new_i64();
1209
1210 switch (idx) {
1211 case 1: /* post-index */
1212 postindex = true;
1213 wback = true;
1214 break;
1215 case 2: /* signed offset, rn not updated */
1216 postindex = false;
1217 break;
1218 case 3: /* STP (pre-index) */
1219 postindex = false;
1220 wback = true;
1221 break;
1222 default: /* Failed decoder tree? */
1223 unallocated_encoding(s);
1224 break;
1225 }
1226
1227 offset <<= size;
1228
1229 if (rn == 31) {
1230 /* XXX check SP alignment */
1231 }
1232 tcg_gen_mov_i64(tcg_addr, cpu_reg_sp(s, rn));
1233
1234 if (!postindex) {
1235 tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1236 }
1237
1238 do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed);
1239 tcg_gen_addi_i64(tcg_addr, tcg_addr, 1 << size);
1240 do_gpr_ld(s, tcg_rt2, tcg_addr, size, is_signed);
1241
1242 // XXX - this could be more optimal?
1243 tcg_gen_subi_i64(tcg_addr, tcg_addr, 1 << size);
1244
1245 if (wback) {
1246 if (postindex) {
1247 tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1248 }
1249 tcg_gen_mov_i64(cpu_reg_sp(s, rn), tcg_addr);
1250 }
1251 tcg_temp_free_i64(tcg_addr);
1252}
1253
1254/*
Alex Bennée871879b2013-11-28 11:18:53 +00001255 C5.6.177 STP (Store Pair - non vector)
1256
1257 31 30 29 26 25 23 22 21 15 14 10 9 5 4 0
1258 +-----+-----------+-------+--+-----------------------------+
1259 | opc | 1 0 1 0 0 | index | 0| imm7 | Rt2 | Rn | Rt |
1260 +-----+-----------+-------+--+-------+-------+------+------+
1261
1262 opc = 00 -> 32 bit, 10 -> 64 bit
1263 index_mode = 01 -> post-index
1264 11 -> pre-index
1265 10 -> signed-offset
1266 Rt, Rt2 = general purpose registers to be stored
1267 Rn = general purpose register containing address
1268 imm7 = signed offset (multiple of 4 or 8 depending on size)
1269 */
1270static void handle_gpr_stp(DisasContext *s, uint32_t insn)
1271{
1272 int rt = extract32(insn, 0, 5);
1273 int rn = extract32(insn, 5, 5);
1274 int rt2 = extract32(insn, 10, 5);
Alex Bennée426998f2013-11-28 13:29:40 +00001275 int64_t offset = sextract32(insn, 15, 7);
Alex Bennée871879b2013-11-28 11:18:53 +00001276 int type = extract32(insn, 23, 2);
1277 int is_32bit = !extract32(insn, 30, 2);
1278
1279 TCGv_i64 tcg_rt = cpu_reg(s, rt);
1280 TCGv_i64 tcg_rt2 = cpu_reg(s, rt2);
1281 TCGv_i64 tcg_addr; /* calculated address */
1282 bool postindex = false;
1283 bool wback = false;
1284 int size = is_32bit ? 2 : 3;
1285
1286 switch (type) {
1287 case 1: /* STP (post-index) */
1288 postindex = true;
1289 wback = true;
1290 break;
1291 case 2: /* STP (signed offset), rn not updated */
1292 postindex = false;
1293 break;
1294 case 3: /* STP (pre-index) */
1295 postindex = false;
1296 wback = true;
1297 break;
1298 default: /* Failed decoder tree? */
1299 unallocated_encoding(s);
1300 break;
1301 }
1302
1303 offset <<= size;
1304
1305 tcg_addr = tcg_temp_new_i64();
1306 if (rn == 31) {
1307 /* XXX CheckSPAlignment - may fault */
1308 }
1309 tcg_gen_mov_i64(tcg_addr, cpu_reg_sp(s, rn));
1310
1311 if (!postindex) {
1312 tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1313 }
1314
1315 do_gpr_st(s, tcg_rt, tcg_addr, size);
1316 tcg_gen_addi_i64(tcg_addr, tcg_addr, 1 << size);
1317 do_gpr_st(s, tcg_rt2, tcg_addr, size);
1318 // XXX - this could be more optimal?
1319 tcg_gen_subi_i64(tcg_addr, tcg_addr, 1 << size);
1320
1321 if (wback) {
1322 if (postindex) {
1323 tcg_gen_addi_i64(tcg_addr, tcg_addr, offset);
1324 }
1325 tcg_gen_mov_i64(cpu_reg_sp(s, rn), tcg_addr);
1326 }
1327
1328 tcg_temp_free_i64(tcg_addr);
1329}
1330
1331
1332/* C2.2.3 Load/store pair (all non vector forms)
1333
1334 31 30 29 26 25 23 22 21 15 14 10 9 5 4 0
1335 +-----+-----------+-------+--+-----------------------------+
1336 | opc | 1 0 1 0 0 | index | L| imm7 | Rt2 | Rn | Rt1 |
1337 +-----+-----------+-------+--+-------+-------+------+------+
1338
1339 opc = 00 -> 32 bit, 10 -> 64 bit, 01 -> LDPSW
1340 L = 0 -> Store, 1 -> Load
1341 index = 01 -> post-index
1342 11 -> pre-index
1343 10 -> signed-index
1344
1345 The following instructions are defined in:
1346 C5.6.81 LDP (Load pair)
1347 C5.6.82 LDPSW (Load pair of registers signed word)
1348 C5.6.177 STP (Store Pair)
1349
1350 31 30 29 22 21 15 14 10 9 5 4 0
1351 +-----+--------------+-----------------------------+
1352 | 0 1 | index_mode | imm7 | Rt2 | Rn | Rt1 |
1353 +-----+--------------+-------+-------+------+------+
1354
1355 opc = 00 -> 32 bit, 10 -> 64 bit
1356 index_mode = 10100011 -> post-index
1357 10100111 -> pre-index
1358 10100101 -> signed offset
1359
1360 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001361static void disas_ldst_pair(DisasContext *s, uint32_t insn)
1362{
Alex Bennée871879b2013-11-28 11:18:53 +00001363 int is_load = extract32(insn, 22, 1);
1364
1365 if (is_load) {
Alex Bennée426998f2013-11-28 13:29:40 +00001366 handle_gpr_ldp(s, insn);
Alex Bennée871879b2013-11-28 11:18:53 +00001367 } else {
1368 handle_gpr_stp(s, insn);
1369 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001370}
1371
Alex Bennéeabc584c2013-12-03 14:58:46 +00001372/*
1373 C3.3.8 Load/store (immediate post-indexed)
1374 C3.3.9 Load/store (immediate pre-indexed)
1375 C3.3.12 Load/store (unscaled immediate)
1376
1377 31 30 29 27 26 25 24 23 22 21 20 12 11 10 9 5 4 0
1378 +----+-------+---+-----+-----+---+--------+-----+------+------+
1379 |size| 1 1 1 | V | 0 0 | opc | 0 | imm9 | idx | Rn | Rt |
1380 +----+-------+---+-----+-----+---+--------+-----+------+------+
1381
1382 idx = 01 -> post-indexed, 11 pre-indexed, 00 unscaled immediate (no writeback)
1383 V = 0 -> non-vector
1384 size: 00 -> 8 bit, 01 -> 16 bit, 10 -> 32 bit, 11 -> 64bit
1385 opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1386*/
1387static void handle_ldst_reg_imm9(DisasContext *s, uint32_t insn)
1388{
1389 int rt = extract32(insn, 0, 5);
1390 int rn = extract32(insn, 5, 5);
1391 int imm9 = sextract32(insn, 12, 9);
1392 int opc = extract32(insn, 22, 2);
1393 int size = extract32(insn, 30, 2);
1394 int idx = extract32(insn, 10, 2);
1395 bool is_signed = false;
1396 bool is_store = false;
1397 bool is_extended = false;
1398 bool is_vector = extract32(insn, 26, 1);
1399 bool post_index;
1400 bool writeback;
1401
1402 TCGv_i64 tcg_rt = cpu_reg(s, rt);
1403 TCGv_i64 tcg_rn = cpu_reg_sp(s, rn);
1404 TCGv_i64 tcg_addr;
1405
1406 if (is_vector) {
1407 unsupported_encoding(s, insn);
1408 return;
1409 }
1410
1411 switch (idx) {
1412 case 0:
1413 post_index = false;
1414 writeback = false;
1415 break;
1416 case 1:
1417 post_index = true;
1418 writeback = true;
1419 break;
1420 case 3:
1421 post_index = false;
1422 writeback = true;
1423 break;
1424 case 2:
1425 g_assert(false);
1426 break;
1427 }
1428
1429 switch (opc) {
1430 case 0:
1431 is_store = true;
1432 break;
1433 case 1:
1434 is_store = false;
1435 is_signed = false;
1436 break;
1437 case 2:
1438 is_store = false;
1439 is_signed = true;
1440 is_extended = true;
1441 break;
1442 case 3:
1443 is_store = false;
1444 is_signed = true;
1445 break;
1446 }
1447
1448 tcg_addr = tcg_temp_new_i64();
1449 tcg_gen_mov_i64(tcg_addr, tcg_rn);
1450
1451 if (!post_index) {
1452 tcg_gen_addi_i64(tcg_addr, tcg_addr, imm9);
1453 }
1454
1455 if (is_store) {
1456 do_gpr_st(s, tcg_rt, tcg_addr, size);
1457 } else {
1458 do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed);
1459 if (is_extended) {
1460 unsupported_encoding(s, insn);
1461 }
1462 }
1463
1464 if (writeback) {
1465 if (post_index) {
1466 tcg_gen_addi_i64(tcg_addr, tcg_addr, imm9);
1467 }
1468 tcg_gen_mov_i64(tcg_rn, tcg_addr);
1469 }
1470
1471 tcg_temp_free_i64(tcg_addr);
1472}
Alex Bennéeb74e71b2013-12-03 09:49:35 +00001473
1474/*
1475 C3.3.10 Load/store (register offset)
1476
1477 31 30 29 27 26 25 24 23 22 21 20 16 15 13 12 11 10 9 4 4 0
1478 +----+-------+---+-----+-----+---+------+-----+--+-----+----+----+
1479 |size| 1 1 1 | V | 0 0 | opc | 1 | Rm | opt | S| 1 0 | Rn | Rt |
1480 +----+-------+---+-----+-----+---+------+-----+--+-----+----+----+
1481
1482 size: 00 -> 8 bit, 01 -> 16 bit, 10 -> 32 bit, 11 -> 64bit
1483 opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1484 V: vector/simd
1485 opt: extend encoding (see DecodeRegExtend)
1486 S: is S=1 then scale (essentially index by sizeof(size))
1487 Rt: register to transfer into/out of
1488 Rn: address register or SP for base
1489 Rm: offset register or ZR for offset
1490*/
1491static void handle_ldst_reg_roffset(DisasContext *s, uint32_t insn)
1492{
1493 int rt = extract32(insn, 0, 5);
1494 int rn = extract32(insn, 5, 5);
1495 int shift = extract32(insn, 12, 1);
1496 int rm = extract32(insn, 16, 5);
1497 int opc = extract32(insn, 22, 2);
1498 int opt = extract32(insn, 13, 3);
1499 int size = extract32(insn, 30, 2);
1500 bool is_signed = false;
1501 bool is_store = false;
1502 bool is_vector = extract32(insn, 26, 1);
1503
1504 TCGv_i64 tcg_rt = cpu_reg(s, rt);
1505 TCGv_i64 tcg_rn = cpu_reg_sp(s, rn);
1506 TCGv_i64 tcg_rm;
1507
1508 TCGv_i64 tcg_addr;
1509
1510 if (is_vector) {
1511 unsupported_encoding(s, insn);
1512 return;
1513 }
1514
1515 if (extract32(opt, 1, 1) == 0) {
1516 unallocated_encoding(s);
1517 return;
1518 }
1519
1520 g_assert(extract32(insn, 10, 2)==2); /* only roffset */
1521 g_assert(extract32(insn, 26, 1)==0); /* not vector */
1522
1523 if (size == 2 && opc == 2) {
1524 /* pre-fetch */
1525 return;
1526 }
1527
1528 switch (opc) {
1529 case 0:
1530 is_store = true;
1531 break;
1532 case 1:
1533 is_store = false;
1534 is_signed = false;
1535 break;
1536 case 2: case 3:
1537 is_store = false;
1538 is_signed = true;
1539 break;
1540 }
1541
1542 tcg_rm = tcg_temp_new_i64();
1543 tcg_addr = tcg_temp_new_i64();
1544
1545 read_cpu_reg(s, tcg_rm, rm, 1);
1546 tcg_gen_mov_i64(tcg_addr, tcg_rn);
1547
1548 ext_and_shift_reg(tcg_rm, tcg_rm, opt, shift ? size : 0);
1549 tcg_gen_add_i64(tcg_addr, tcg_addr, tcg_rm);
1550 if (is_store) {
1551 do_gpr_st(s, tcg_rt, tcg_addr, size);
1552 } else {
1553 do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed);
1554 }
1555 tcg_temp_free_i64(tcg_rm);
1556 tcg_temp_free_i64(tcg_addr);
1557}
1558
Alex Bennéeefe92a72013-11-28 11:19:31 +00001559/*
1560C3.3.13 Load/store (unsigned immediate)
1561
1562 31 30 29 27 26 25 24 23 22 21 10 9 5
1563 +----+-------+---+-----+-----+------------+-------+------+
1564 |size| 1 1 1 | V | 0 1 | opc | imm12 | Rn | Rt |
1565 +----+-------+---+-----+-----+------------+-------+------+
1566
1567 For non-vector:
1568 size: 00-> byte, 01 -> 16 bit, 10 -> 32bit, 11 -> 64bit
1569 opc: 00 -> store, 01 -> loadu, 10 -> loads 64, 11 -> loads 32
1570 For vector:
1571 size is opc<1>:size<1:0> so 100 -> 128 bit; 110 and 111 unallocated
1572 opc<0>: 0 -> store, 1 -> load
1573 Rn: base address register (inc SP)
1574 Rt: target register
1575*/
1576static void handle_ldst_reg_unsigned_imm(DisasContext *s, uint32_t insn)
1577{
1578 int rt = extract32(insn, 0, 5);
1579 int rn = extract32(insn, 5, 5);
1580 unsigned int imm12 = extract32(insn, 10, 12);
1581 bool is_vector = extract32(insn, 26, 1);
1582 int size = extract32(insn, 30, 2);
1583 int opc = extract32(insn, 22, 2);
1584 unsigned int offset;
1585
1586 TCGv_i64 tcg_rn;
1587 TCGv_i64 tcg_rt;
1588 TCGv_i64 tcg_addr;
1589
1590 bool is_store, is_signed;
1591
1592 if (is_vector) {
1593 size |= (opc & 2) << 1;
1594 if (size > 4) {
1595 unallocated_encoding(s);
1596 }
1597 is_store = ((opc & 1) == 0);
1598 } else {
1599 if (size == 3 && opc == 2) {
1600 /* PRFM - prefetch */
1601 return;
1602 }
1603 is_store = (opc == 0);
1604 is_signed = opc & (1<<1);
1605 }
1606
1607 tcg_rn = cpu_reg_sp(s, rn);
1608 tcg_addr = tcg_temp_new_i64();
1609
1610 offset = imm12 << size;
1611 tcg_gen_addi_i64(tcg_addr, tcg_rn, offset);
1612
1613 if (is_vector) {
1614 if (is_store) {
1615 do_fp_st(s, rt, tcg_addr, size);
1616 } else {
1617 do_fp_ld(s, rt, tcg_addr, size);
1618 }
1619 } else {
1620 tcg_rt = cpu_reg(s, rt);
1621 if (is_store) {
1622 do_gpr_st(s, tcg_rt, tcg_addr, size);
1623 } else {
1624 do_gpr_ld(s, tcg_rt, tcg_addr, size, is_signed);
1625 }
1626 }
1627 tcg_temp_free_i64(tcg_addr);
1628}
1629
Alex Bennéeabc584c2013-12-03 14:58:46 +00001630/* Load/store register (immediate forms) */
1631static void disas_ldst_reg_imm(DisasContext *s, uint32_t insn)
1632{
1633 switch (extract32(insn, 10, 2)) {
1634 case 0: case 1: case 3:
1635 /* Load/store register (unscaled immediate) */
1636 /* Load/store immediate pre/post-indexed */
1637 handle_ldst_reg_imm9(s, insn);
1638 break;
1639 case 2:
1640 /* Load/store register unprivileged */
1641 unsupported_encoding(s, insn);
1642 break;
1643 default:
1644 unallocated_encoding(s);
1645 break;
1646 }
1647}
1648
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001649/* Load/store register (all forms) */
1650static void disas_ldst_reg(DisasContext *s, uint32_t insn)
1651{
Alex Bennéeefe92a72013-11-28 11:19:31 +00001652 switch (extract32(insn, 24, 2)) {
1653 case 0:
Alex Bennéeb74e71b2013-12-03 09:49:35 +00001654 if (extract32(insn, 21,1)) {
1655 handle_ldst_reg_roffset(s, insn);
1656 } else {
Alex Bennéeabc584c2013-12-03 14:58:46 +00001657 disas_ldst_reg_imm(s, insn);
Alex Bennéeb74e71b2013-12-03 09:49:35 +00001658 }
Alex Bennéeefe92a72013-11-28 11:19:31 +00001659 break;
1660 case 1:
1661 handle_ldst_reg_unsigned_imm(s, insn);
1662 break;
1663 default:
1664 unallocated_encoding(s);
1665 break;
1666 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001667}
1668
1669/* AdvSIMD load/store multiple structures */
1670static void disas_ldst_multiple_struct(DisasContext *s, uint32_t insn)
1671{
1672 unsupported_encoding(s, insn);
1673}
1674
1675/* AdvSIMD load/store single structure */
1676static void disas_ldst_single_struct(DisasContext *s, uint32_t insn)
1677{
1678 unsupported_encoding(s, insn);
1679}
1680
1681/* C3.3 Loads and stores */
1682static void disas_ldst(DisasContext *s, uint32_t insn)
1683{
1684 switch (extract32(insn, 24, 6)) {
1685 case 0x08: /* Load/store exclusive */
1686 disas_ldst_excl(s, insn);
1687 break;
1688 case 0x18: case 0x1c: /* Load register (literal) */
Alex Bennée0d680852013-11-25 14:34:40 +00001689 handle_ld_lit(s, insn);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001690 break;
1691 case 0x28: case 0x29:
1692 case 0x2c: case 0x2d: /* Load/store pair (all forms) */
1693 disas_ldst_pair(s, insn);
1694 break;
1695 case 0x38: case 0x39:
1696 case 0x3c: case 0x3d: /* Load/store register (all forms) */
1697 disas_ldst_reg(s, insn);
1698 break;
1699 case 0x0c: /* AdvSIMD load/store multiple structures */
1700 disas_ldst_multiple_struct(s, insn);
1701 break;
1702 case 0x0d: /* AdvSIMD load/store single structure */
1703 disas_ldst_single_struct(s, insn);
1704 break;
1705 default:
1706 unallocated_encoding(s);
1707 break;
1708 }
1709}
1710
Claudio Fontana8ff4c2f2013-12-03 15:12:19 +00001711/* C3.4.6 PC-rel. addressing */
1712
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001713static void disas_pc_rel_adr(DisasContext *s, uint32_t insn)
1714{
Claudio Fontana8ff4c2f2013-12-03 15:12:19 +00001715 /*
1716 * 31 30 29 28 27 26 25 24 23 5 4 0
1717 * op immlo 1 0 0 0 0 immhi Rd
1718 */
1719 unsigned int page, rd; /* op -> page */
1720 uint64_t base;
1721 int64_t offset; /* SignExtend(immhi:immlo) -> offset */
1722
1723 page = insn & (1 << 31) ? 1 : 0;
1724 offset = ((int64_t)sextract32(insn, 5, 19) << 2) | extract32(insn, 29, 2);
1725 rd = extract32(insn, 0, 5);
1726 base = s->pc - 4;
1727
1728 if (page) {
1729 /* ADRP (page based) */
1730 base &= ~0xfff;
1731 offset <<= 12; /* apply Zeros */
1732 }
1733
1734 tcg_gen_movi_i64(cpu_reg(s, rd), base + offset);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001735}
1736
Alex Bennéeffb7dab2013-12-03 10:52:22 +00001737/* C3.4.1 Add/subtract (immediate)
1738
1739 31 30 29 28 24 23 22 21 10 9 5 4 0
1740 +--+--+--+-----------+-----+-------------+-----+-----+
1741 |sf|op| S| 1 0 0 0 1 |shift| imm12 | Rn | Rd |
1742 +--+--+--+-----------+-----+-------------+-----+-----+
1743
1744 sf: 0 -> 32bit, 1 -> 64bit
1745 op: 0 -> add , 1 -> sub
1746 S: 1 -> set flags
1747shift: 00 -> LSL imm by 0, 01 -> LSL imm by 12
1748*/
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001749static void disas_add_sub_imm(DisasContext *s, uint32_t insn)
1750{
Alex Bennéeffb7dab2013-12-03 10:52:22 +00001751 int rd = extract32(insn, 0, 5);
1752 int rn = extract32(insn, 5, 5);
1753 uint64_t imm = extract32(insn, 10, 12);
1754 int shift = extract32(insn, 22, 2);
1755 bool setflags = extract32(insn, 29, 1);
1756 bool sub_op = extract32(insn, 30, 1);
1757 bool is_64bit = extract32(insn, 31, 1);
1758
1759 TCGv_i64 tcg_rn = cpu_reg_sp(s, rn);
1760 TCGv_i64 tcg_rd = setflags ? cpu_reg(s, rd):cpu_reg_sp(s, rd);
1761 TCGv_i64 tcg_result;
1762
1763 switch (shift) {
1764 case 0x0:
1765 break;
1766 case 0x1:
1767 imm <<= 12;
1768 break;
1769 default:
1770 unallocated_encoding(s);
1771 }
1772
1773 tcg_result = tcg_temp_new_i64();
1774 if (!setflags) {
1775 if (sub_op) {
1776 tcg_gen_subi_i64(tcg_result, tcg_rn, imm);
1777 } else {
1778 tcg_gen_addi_i64(tcg_result, tcg_rn, imm);
1779 }
1780 } else {
1781 TCGv_i64 tcg_imm = tcg_const_i64(imm);
1782 if (sub_op) {
1783 gen_sub_CC(is_64bit, tcg_result, tcg_rn, tcg_imm);
1784 } else {
1785 gen_add_CC(is_64bit, tcg_result, tcg_rn, tcg_imm);
1786 }
1787 tcg_temp_free_i64(tcg_imm);
1788 }
1789
1790 if (is_64bit) {
1791 tcg_gen_mov_i64(tcg_rd, tcg_result);
1792 } else {
1793 tcg_gen_ext32u_i64(tcg_rd, tcg_result);
1794 }
1795
1796 tcg_temp_free_i64(tcg_result);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001797}
1798
Claudio Fontanab5a339a2013-12-03 15:12:21 +00001799static uint64_t logic_imm_replicate(uint64_t mask, unsigned int esize)
1800{
1801 int i;
1802 uint64_t out_mask = 0;
1803 for (i = 0; (i * esize) < 64; i++) {
1804 out_mask = out_mask | (mask << (i * esize));
1805 }
1806 return out_mask;
1807}
1808
1809static inline uint64_t logic_imm_bitmask(unsigned int len)
1810{
1811 if (len == 64) {
1812 return -1;
1813 }
1814 return (1ULL << len) - 1;
1815}
1816
1817static uint64_t logic_imm_decode_wmask(unsigned int immn,
1818 unsigned int imms, unsigned int immr)
1819{
1820 uint64_t mask;
1821 unsigned len, esize, levels, s, r;
1822
1823 len = 31 - clz32((immn << 6) | (~imms & 0x3f));
1824 esize = 1 << len;
1825 levels = (esize - 1) & 0x3f;
1826 s = imms & levels;
1827 r = immr & levels;
1828
1829 mask = logic_imm_bitmask(s + 1);
1830 mask = (mask >> r) | (mask << (esize - r));
1831 mask &= logic_imm_bitmask(esize);
1832 mask = logic_imm_replicate(mask, esize);
1833 return mask;
1834}
1835
1836/* C3.4.4 Logical (immediate) */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001837static void disas_logic_imm(DisasContext *s, uint32_t insn)
1838{
Claudio Fontanab5a339a2013-12-03 15:12:21 +00001839 /*
1840 * 31 30 29 28 27 26 25 24 23 22 21 16 15 10 9 5 4 0
1841 * sf opc 1 0 0 1 0 0 N immr imms Rn Rd
1842 */
1843 unsigned int sf, opc, is_n, immr, imms, rn, rd;
1844 TCGv_i64 tcg_rd, tcg_rn;
1845 uint64_t wmask;
1846 sf = insn & (1 << 31) ? 1 : 0;
1847 opc = extract32(insn, 29, 2);
1848 is_n = insn & (1 << 22) ? 1 : 0;
1849 immr = extract32(insn, 16, 6);
1850 imms = extract32(insn, 10, 6);
1851 rn = extract32(insn, 5, 5);
1852 rd = extract32(insn, 0, 5);
1853
1854 if (!sf && is_n) {
1855 unallocated_encoding(s);
1856 return;
1857 }
1858
1859 if (opc == 0x3) { /* ANDS */
1860 tcg_rd = cpu_reg(s, rd);
1861 } else {
1862 tcg_rd = cpu_reg_sp(s, rd);
1863 }
1864 tcg_rn = cpu_reg(s, rn);
1865
1866 wmask = logic_imm_decode_wmask(is_n, imms, immr);
1867 if (!sf) {
1868 wmask &= 0xffffffff;
1869 }
1870
1871 switch (opc) {
1872 case 0x3: /* ANDS */
1873 case 0x0: /* AND */
1874 tcg_gen_andi_i64(tcg_rd, tcg_rn, wmask);
1875 break;
1876 case 0x1: /* ORR */
1877 tcg_gen_ori_i64(tcg_rd, tcg_rn, wmask);
1878 break;
1879 case 0x2: /* EOR */
1880 tcg_gen_xori_i64(tcg_rd, tcg_rn, wmask);
1881 break;
1882 default:
1883 assert(FALSE); /* must handle all above */
1884 break;
1885 }
1886
1887 if (!sf) { /* zero extend final result */
1888 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
1889 }
1890
1891 if (opc == 3) { /* ANDS */
1892 gen_logic_CC(sf, tcg_rd);
1893 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001894}
1895
Alex Bennéec2573912013-11-22 17:10:59 +00001896/* C3.4.5 Move wide (immediate)
1897
1898 31 30 29 28 23 22 21 20 5 4 0
1899 +--+-----+-------------+-----+----------------+------+
1900 |sf| opc | 1 0 0 1 0 1 | hw | imm16 | Rd |
1901 +--+-----+-------------+-----+----------------+------+
1902
1903 sf: 0 -> 32 bit, 1 -> 64 bit
1904 opc: 00 -> N, 01 -> Z, 11 -> K
1905 */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001906static void disas_movw_imm(DisasContext *s, uint32_t insn)
1907{
Alex Bennéec2573912013-11-22 17:10:59 +00001908 int rd = extract32(insn, 0, 5);
1909 uint64_t imm = extract32(insn, 5, 16);
1910 int is_32bit = !extract32(insn, 31, 1);
1911 int is_k = extract32(insn, 29, 1);
1912 int is_n = !extract32(insn, 30, 1);
1913 int pos = extract32(insn, 21, 2) << 4;
1914 TCGv_i64 tcg_rd = cpu_reg(s, rd);
1915 TCGv_i64 tcg_imm;
1916
1917 if (extract32(insn, 23, 1) != 1) {
1918 /* reserved */
1919 unallocated_encoding(s);
1920 return;
1921 }
1922
1923 if (is_k && is_n) {
1924 unallocated_encoding(s);
1925 return;
1926 }
1927
1928 if (is_k) {
1929 tcg_imm = tcg_const_i64(imm);
1930 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_imm, pos, 16);
1931 tcg_temp_free_i64(tcg_imm);
1932 } else {
1933 imm <<= pos;
1934 if (is_n) {
1935 imm = ~imm;
1936 }
1937 if (is_32bit) {
1938 imm &= 0xffffffffu;
1939 }
1940 tcg_gen_movi_i64(tcg_rd, imm);
1941 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001942}
1943
Claudio Fontana18f20eb2013-12-03 15:12:21 +00001944/* C3.4.2 Bitfield */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001945static void disas_bitfield(DisasContext *s, uint32_t insn)
1946{
Claudio Fontana18f20eb2013-12-03 15:12:21 +00001947 /*
1948 * 31 30 29 28 27 26 25 24 23 22 21 16 15 10 9 5 4 0
1949 * sf opc 1 0 0 1 1 0 N immr imms Rn Rd
1950 */
1951 unsigned int sf, n, opc, ri, si, rn, rd, bitsize, pos, len;
1952 TCGv_i64 tcg_rd, tcg_tmp;
1953 sf = insn & (1 << 31) ? 1 : 0;
1954 opc = extract32(insn, 29, 2);
1955 n = insn & (1 << 22) ? 1 : 0;
1956 ri = extract32(insn, 16, 6);
1957 si = extract32(insn, 10, 6);
1958 rn = extract32(insn, 5, 5);
1959 rd = extract32(insn, 0, 5);
1960 bitsize = sf ? 64 : 32;
1961
1962 if (sf != n || ri >= bitsize || si >= bitsize || opc > 2) {
1963 unallocated_encoding(s);
1964 return;
1965 }
1966
1967 tcg_rd = cpu_reg(s, rd);
1968 tcg_tmp = tcg_temp_new_i64();
1969 read_cpu_reg(s, tcg_tmp, rn, sf);
1970
1971 if (opc != 1) { /* SBFM or UBFM */
1972 tcg_gen_movi_i64(tcg_rd, 0);
1973 }
1974
1975 /* do the bit move operation */
1976 if (si >= ri) {
1977 /* Wd<s-r:0> = Wn<s:r> */
1978 tcg_gen_shri_i64(tcg_tmp, tcg_tmp, ri);
1979 pos = 0;
1980 len = (si - ri) + 1;
1981 } else {
1982 /* Wd<32+s-r,32-r> = Wn<s:0> */
1983 pos = bitsize - ri;
1984 len = si + 1;
1985 }
1986
1987 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, pos, len);
1988 tcg_temp_free_i64(tcg_tmp);
1989
1990 if (opc == 0) { /* SBFM - sign extend the destination field */
1991 tcg_gen_shli_i64(tcg_rd, tcg_rd, 64 - (pos + len));
1992 tcg_gen_sari_i64(tcg_rd, tcg_rd, 64 - (pos + len));
1993 }
1994
1995 if (!sf) { /* zero extend final result */
1996 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
1997 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00001998}
1999
Claudio Fontana6e7015312013-12-03 15:12:19 +00002000/* C3.4.3 Extract */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002001static void disas_extract(DisasContext *s, uint32_t insn)
2002{
Claudio Fontana6e7015312013-12-03 15:12:19 +00002003 /*
2004 * 31 30 29 28 27 26 25 24 23 22 21 20 16 15 10 9 5 4 0
2005 * sf [op21] 1 0 0 1 1 1 N o0 Rm imm Rn Rd
2006 * [0 0] [0]
2007 */
2008 unsigned int sf, n, rm, imm, rn, rd, bitsize, op;
2009 sf = insn & (1 << 31) ? 1 : 0;
2010 n = insn & (1 << 22) ? 1 : 0;
2011 rm = extract32(insn, 16, 5);
2012 imm = extract32(insn, 10, 6);
2013 rn = extract32(insn, 5, 5);
2014 rd = extract32(insn, 0, 5);
2015 op = insn & (0x3 << 29 | 1 << 21);
2016 bitsize = sf ? 64 : 32;
2017
2018 if (sf != n || op || imm >= bitsize) {
2019 unallocated_encoding(s);
2020 } else {
2021 TCGv_i64 tcg_tmp, tcg_rd;
2022 tcg_tmp = tcg_temp_new_i64();
2023 tcg_rd = cpu_reg(s, rd);
2024
2025 read_cpu_reg(s, tcg_tmp, rm, sf);
2026 tcg_gen_shri_i64(tcg_rd, tcg_tmp, imm);
2027 tcg_gen_shli_i64(tcg_tmp, cpu_reg(s, rn), bitsize - imm);
2028 tcg_gen_or_i64(tcg_rd, tcg_rd, tcg_tmp);
2029
2030 tcg_temp_free_i64(tcg_tmp);
2031 if (!sf) {
2032 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2033 }
2034 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002035}
2036
2037/* C3.4 Data processing - immediate */
2038static void disas_data_proc_imm(DisasContext *s, uint32_t insn)
2039{
2040 switch (extract32(insn, 23, 6)) {
2041 case 0x20: case 0x21: /* PC-rel. addressing */
2042 disas_pc_rel_adr(s, insn);
2043 break;
2044 case 0x22: case 0x23: /* Add/subtract (immediate) */
2045 disas_add_sub_imm(s, insn);
2046 break;
2047 case 0x24: /* Logical (immediate) */
2048 disas_logic_imm(s, insn);
2049 break;
2050 case 0x25: /* Move wide (immediate) */
2051 disas_movw_imm(s, insn);
2052 break;
2053 case 0x26: /* Bitfield */
2054 disas_bitfield(s, insn);
2055 break;
2056 case 0x27: /* Extract */
2057 disas_extract(s, insn);
2058 break;
2059 default:
2060 unallocated_encoding(s);
2061 break;
2062 }
2063}
2064
Claudio Fontanad41620e2013-12-03 15:12:19 +00002065/* shift a TCGv src by TCGv shift_amount, put result in dst. */
2066static void shift_reg(TCGv_i64 dst, TCGv_i64 src, int sf,
2067 enum a64_shift_type shift_type, TCGv_i64 shift_amount)
2068{
2069 switch (shift_type) {
2070 case A64_SHIFT_TYPE_LSL:
2071 tcg_gen_shl_i64(dst, src, shift_amount);
2072 break;
2073 case A64_SHIFT_TYPE_LSR:
2074 tcg_gen_shr_i64(dst, src, shift_amount);
2075 break;
2076 case A64_SHIFT_TYPE_ASR:
2077 if (!sf) {
2078 tcg_gen_ext32s_i64(dst, src);
2079 }
2080 tcg_gen_sar_i64(dst, sf ? src : dst, shift_amount);
2081 break;
2082 case A64_SHIFT_TYPE_ROR:
2083 if (sf) {
2084 tcg_gen_rotr_i64(dst, src, shift_amount);
2085 } else {
2086 TCGv_i32 t0, t1;
2087 t0 = tcg_temp_new_i32();
2088 t1 = tcg_temp_new_i32();
2089 tcg_gen_trunc_i64_i32(t0, src);
2090 tcg_gen_trunc_i64_i32(t1, shift_amount);
2091 tcg_gen_rotr_i32(t0, t0, t1);
2092 tcg_gen_extu_i32_i64(dst, t0);
2093 tcg_temp_free_i32(t0);
2094 tcg_temp_free_i32(t1);
2095 }
2096 break;
2097 default:
2098 assert(FALSE); /* all shift types should be handled */
2099 break;
2100 }
2101
2102 if (!sf) { /* zero extend final result */
2103 tcg_gen_ext32u_i64(dst, dst);
2104 }
2105}
2106
2107/* shift a TCGv src by immediate, put result in dst. */
2108static void shift_reg_imm(TCGv_i64 dst, TCGv_i64 src, int sf,
2109 enum a64_shift_type shift_type, unsigned int shift_i)
2110{
2111 shift_i = shift_i & (sf ? 63 : 31);
2112
2113 if (shift_i == 0) {
2114 tcg_gen_mov_i64(dst, src);
2115 } else {
2116 TCGv_i64 shift_const;
2117 shift_const = tcg_const_i64(shift_i);
2118 shift_reg(dst, src, sf, shift_type, shift_const);
2119 tcg_temp_free_i64(shift_const);
2120 }
2121}
2122
2123/* C3.5.10 Logical (shifted register) */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002124static void disas_logic_reg(DisasContext *s, uint32_t insn)
2125{
Claudio Fontanad41620e2013-12-03 15:12:19 +00002126 /*
2127 * 31 30 29 28 27 26 25 24 23 22 21 20 16 15 10 9 5 4 0
2128 * sf opc 0 1 0 1 0 shift N Rm imm6 Rn Rd
2129 */
2130 TCGv_i64 tcg_rd, tcg_rn, tcg_rm;
2131 unsigned int sf, opc, shift_type, invert, rm, shift_amount, rn, rd;
2132 sf = (insn & (1 << 31)) ? 1 : 0;
2133 opc = extract32(insn, 29, 2);
2134 shift_type = extract32(insn, 22, 2);
2135 invert = (insn & (1 << 21)) ? 1 : 0;
2136 rm = extract32(insn, 16, 5);
2137 shift_amount = extract32(insn, 10, 6);
2138 rn = extract32(insn, 5, 5);
2139 rd = extract32(insn, 0, 5);
2140
2141 if (!sf && (shift_amount & (1 << 5))) {
2142 unallocated_encoding(s);
2143 return;
2144 }
2145
2146 tcg_rm = tcg_temp_new_i64();
2147 read_cpu_reg(s, tcg_rm, rm, sf);
2148
2149 if (shift_amount) {
2150 shift_reg_imm(tcg_rm, tcg_rm, sf,
2151 shift_type, shift_amount);
2152 }
2153
2154 if (invert) {
2155 tcg_gen_not_i64(tcg_rm, tcg_rm);
2156 /* we zero extend later on (!sf) */
2157 }
2158
2159 tcg_rd = cpu_reg(s, rd);
2160 tcg_rn = cpu_reg(s, rn);
2161
2162 switch (opc) {
2163 case 0: /* AND, BIC */
2164 case 3: /* ANDS, BICS */
2165 tcg_gen_and_i64(tcg_rd, tcg_rn, tcg_rm);
2166 break;
2167 case 1: /* ORR, ORN */
2168 tcg_gen_or_i64(tcg_rd, tcg_rn, tcg_rm);
2169 break;
2170 case 2: /* EOR, EON */
2171 tcg_gen_xor_i64(tcg_rd, tcg_rn, tcg_rm);
2172 break;
2173 default:
2174 assert(FALSE); /* must handle all in switch */
2175 break;
2176 }
2177
2178 if (!sf) {
2179 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2180 }
2181
2182 if (opc == 3) {
2183 gen_logic_CC(sf, tcg_rd);
2184 }
2185
2186 tcg_temp_free_i64(tcg_rm);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002187}
2188
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002189/* C3.5.1 Add/subtract (extended register)
2190
2191 31|30|29|28 24|23 22|21|20 16|15 13|12 10|9 5|4 0|
2192 +--+--+--+-----------+-----+--+-------+------+------+----+----+
2193 |sf|op| S| 0 1 0 1 1 | opt | 1| Rm |option| imm3 | Rn | Rd |
2194 +--+--+--+-----------+-----+--+-------+------+------+----+----+
2195
2196 sf: 0 -> 32bit, 1 -> 64bit
2197 op: 0 -> add , 1 -> sub
2198 S: 1 -> set flags
2199 opt: 00
2200 option: extension type (see DecodeRegExtend)
2201 imm3: optional shift to Rm
2202
2203 Rd = Rn + LSL(extend(Rm), amount)
2204*/
2205
2206static void handle_add_sub_ext_reg(DisasContext *s, uint32_t insn)
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002207{
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002208 int rd = extract32(insn, 0, 5);
2209 int rn = extract32(insn, 5, 5);
2210 int imm3 = sextract32(insn, 10, 3);
2211 int option = extract32(insn, 13, 3);
2212 int rm = extract32(insn, 16, 5);
2213 bool setflags = extract32(insn, 29, 1);
2214 bool sub_op = extract32(insn, 30, 1);
2215 bool sf = extract32(insn, 31, 1);
2216
2217 TCGv_i64 tcg_rm = tcg_temp_new_i64();
2218 TCGv_i64 tcg_rn = tcg_temp_new_i64();
2219
2220 TCGv_i64 tcg_rd;
2221 TCGv_i64 tcg_result;
2222
2223 /* non-flag setting ops may use SP */
2224 if (!setflags) {
2225 read_cpu_reg_sp(s, tcg_rn, rn, sf);
2226 tcg_gen_mov_i64(tcg_rn, cpu_reg_sp(s, rn));
2227 tcg_rd = cpu_reg_sp(s, rd);
2228 } else {
2229 read_cpu_reg(s, tcg_rn, rn, sf);
2230 tcg_rd = cpu_reg(s, rd);
2231 }
2232
2233 read_cpu_reg(s, tcg_rm, rm, sf);
2234 ext_and_shift_reg(tcg_rm, tcg_rm, option, imm3);
2235
2236 tcg_result = tcg_temp_new_i64();
2237
2238 if (!setflags) {
2239 if (sub_op) {
2240 tcg_gen_sub_i64(tcg_result, tcg_rn, tcg_rm);
2241 } else {
2242 tcg_gen_add_i64(tcg_result, tcg_rn, tcg_rm);
2243 }
2244 } else {
2245 if (sub_op) {
2246 gen_sub_CC(sf, tcg_result, tcg_rn, tcg_rm);
2247 } else {
2248 gen_add_CC(sf, tcg_result, tcg_rn, tcg_rm);
2249 }
2250 }
2251
2252 if (sf) {
2253 tcg_gen_mov_i64(tcg_rd, tcg_result);
2254 } else {
2255 tcg_gen_ext32u_i64(tcg_rd, tcg_result);
2256 }
2257
2258 tcg_temp_free_i64(tcg_result);
2259 tcg_temp_free_i64(tcg_rm);
2260 tcg_temp_free_i64(tcg_rn);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002261}
2262
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002263/* C3.5.2 Add/subtract (shifted register)
2264
2265 31 30 29 28 24 23 22 21 20 16 15 10 9 5 4 0
2266 +--+--+--+-----------+-----+--+-------+---------+------+------+
2267 |sf|op| S| 0 1 0 1 1 |shift| 0| Rm | imm6 | Rn | Rd |
2268 +--+--+--+-----------+-----+--+-------+---------+------+------+
2269
2270 sf: 0 -> 32bit, 1 -> 64bit
2271 op: 0 -> add , 1 -> sub
2272 S: 1 -> set flags
2273shift: apply a shift of imm6 to Rm before the add/sub
2274 */
2275static void handle_add_sub_reg(DisasContext *s, uint32_t insn)
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002276{
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002277 int rd = extract32(insn, 0, 5);
2278 int rn = extract32(insn, 5, 5);
2279 int shift_amount = sextract32(insn, 10, 6);
2280 int rm = extract32(insn, 16, 5);
2281 int shift_type = extract32(insn, 22, 2);
2282 bool setflags = extract32(insn, 29, 1);
2283 bool sub_op = extract32(insn, 30, 1);
2284 bool sf = extract32(insn, 31, 1);
2285
2286 TCGv_i64 tcg_rd = cpu_reg(s, rd);
2287 TCGv_i64 tcg_rn = tcg_temp_new_i64();
2288 TCGv_i64 tcg_rm = tcg_temp_new_i64();
2289 TCGv_i64 tcg_result;
2290
2291 read_cpu_reg(s, tcg_rn, rn, sf);
2292 read_cpu_reg(s, tcg_rm, rm, sf);
2293 /* Rm is optionally shifted */
2294 shift_reg_imm(tcg_rm, tcg_rm, sf, shift_type, shift_amount);
2295
2296 tcg_result = tcg_temp_new_i64();
2297
2298 if (!setflags) {
2299 if (sub_op) {
2300 tcg_gen_sub_i64(tcg_result, tcg_rn, tcg_rm);
2301 } else {
2302 tcg_gen_add_i64(tcg_result, tcg_rn, tcg_rm);
2303 }
2304 } else {
2305 if (sub_op) {
2306 gen_sub_CC(sf, tcg_result, tcg_rn, tcg_rm);
2307 } else {
2308 gen_add_CC(sf, tcg_result, tcg_rn, tcg_rm);
2309 }
2310 }
2311
2312 if (sf) {
2313 tcg_gen_mov_i64(tcg_rd, tcg_result);
2314 } else {
2315 tcg_gen_ext32u_i64(tcg_rd, tcg_result);
2316 }
2317
2318 tcg_temp_free_i64(tcg_result);
2319 tcg_temp_free_i64(tcg_rn);
2320 tcg_temp_free_i64(tcg_rm);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002321}
2322
2323/* Data-processing (3 source) */
2324static void disas_data_proc_3src(DisasContext *s, uint32_t insn)
2325{
2326 unsupported_encoding(s, insn);
2327}
2328
2329/* Add/subtract (with carry) */
2330static void disas_adc_sbc(DisasContext *s, uint32_t insn)
2331{
2332 unsupported_encoding(s, insn);
2333}
2334
2335/* Conditional compare (immediate) */
2336static void disas_cc_imm(DisasContext *s, uint32_t insn)
2337{
2338 unsupported_encoding(s, insn);
2339}
2340
2341/* Conditional compare (register) */
2342static void disas_cc_reg(DisasContext *s, uint32_t insn)
2343{
2344 unsupported_encoding(s, insn);
2345}
2346
Claudio Fontana926f3f32013-12-03 15:12:19 +00002347/* C3.5.6 Conditional select */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002348static void disas_cond_select(DisasContext *s, uint32_t insn)
2349{
Claudio Fontana926f3f32013-12-03 15:12:19 +00002350 /*
2351 * 31 30 29 28 27 26 25 24 23 22 21 20 16 15 12 11 10 9 5 4 0
2352 * sf op S 1 1 0 1 0 1 0 0 Rm cond op2 Rn Rd
2353 * [0]
2354 * op -> else_inv, op2 -> else_inc
2355 */
2356 unsigned int sf, else_inv, rm, cond, else_inc, rn, rd;
2357 TCGv_i64 tcg_rd;
2358 if (extract32(insn, 21, 9) != 0x0d4 || (insn & (1 << 11))) {
2359 unallocated_encoding(s);
2360 return;
2361 }
2362 sf = (insn & (1 << 31)) ? 1 : 0;
2363 else_inv = extract32(insn, 30, 1);
2364 rm = extract32(insn, 16, 5);
2365 cond = extract32(insn, 12, 4);
2366 else_inc = extract32(insn, 10, 1);
2367 rn = extract32(insn, 5, 5);
2368 rd = extract32(insn, 0, 5);
2369 tcg_rd = cpu_reg(s, rd);
2370
2371 if (cond >= 0x0e) { /* condition "always" */
2372 read_cpu_reg(s, tcg_rd, rn, sf);
2373 } else {
2374 int label_nomatch, label_continue;
2375 label_nomatch = gen_new_label();
2376 label_continue = gen_new_label();
2377
2378 arm_gen_test_cc(cond ^ 1, label_nomatch);
2379 /* match: */
2380 read_cpu_reg(s, tcg_rd, rn, sf);
2381 tcg_gen_br(label_continue);
2382 /* nomatch: */
2383 gen_set_label(label_nomatch);
2384 read_cpu_reg(s, tcg_rd, rm, sf);
2385 if (else_inv) {
2386 tcg_gen_not_i64(tcg_rd, tcg_rd);
2387 }
2388 if (else_inc) {
2389 tcg_gen_addi_i64(tcg_rd, tcg_rd, 1);
2390 }
2391 if (!sf) {
2392 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2393 }
2394 /* continue: */
2395 gen_set_label(label_continue);
2396 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002397}
2398
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002399static void handle_clz(DisasContext *s, unsigned int sf,
2400 unsigned int rn, unsigned int rd)
2401{
2402 TCGv_i64 tcg_rd, tcg_rn;
2403 tcg_rd = cpu_reg(s, rd);
2404 tcg_rn = cpu_reg(s, rn);
2405
2406 if (sf) {
2407 gen_helper_clz64(tcg_rd, tcg_rn);
2408 } else {
2409 TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
2410 tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
2411 gen_helper_clz(tcg_tmp32, tcg_tmp32);
2412 tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
2413 tcg_temp_free_i32(tcg_tmp32);
2414 }
2415}
2416
Claudio Fontanaded37772013-12-03 15:12:21 +00002417static void handle_cls(DisasContext *s, unsigned int sf,
2418 unsigned int rn, unsigned int rd)
2419{
2420 TCGv_i64 tcg_rd, tcg_rn;
2421 tcg_rd = cpu_reg(s, rd);
2422 tcg_rn = cpu_reg(s, rn);
2423
2424 if (sf) {
2425 gen_helper_cls64(tcg_rd, tcg_rn);
2426 } else {
2427 TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
2428 tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
2429 gen_helper_cls32(tcg_tmp32, tcg_tmp32);
2430 tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
2431 tcg_temp_free_i32(tcg_tmp32);
2432 }
2433}
2434
Claudio Fontana071b11d2013-12-03 15:12:20 +00002435static void handle_rbit(DisasContext *s, unsigned int sf,
2436 unsigned int rn, unsigned int rd)
2437{
2438 TCGv_i64 tcg_rd, tcg_rn;
2439 tcg_rd = cpu_reg(s, rd);
2440 tcg_rn = cpu_reg(s, rn);
2441
2442 if (sf) {
2443 gen_helper_rbit64(tcg_rd, tcg_rn);
2444 } else {
2445 TCGv_i32 tcg_tmp32 = tcg_temp_new_i32();
2446 tcg_gen_trunc_i64_i32(tcg_tmp32, tcg_rn);
2447 gen_helper_rbit(tcg_tmp32, tcg_tmp32);
2448 tcg_gen_extu_i32_i64(tcg_rd, tcg_tmp32);
2449 tcg_temp_free_i32(tcg_tmp32);
2450 }
2451}
2452
Claudio Fontanacdd4f722013-12-03 15:12:20 +00002453/* C5.6.149 REV with sf==1, opcode==3 ("REV64") */
2454static void handle_rev64(DisasContext *s, unsigned int sf,
2455 unsigned int rn, unsigned int rd)
2456{
2457 if (!sf) {
2458 unallocated_encoding(s);
2459 return;
2460 }
2461 tcg_gen_bswap64_i64(cpu_reg(s, rd), cpu_reg(s, rn));
2462}
2463
2464/* C5.6.149 REV with sf==0, opcode==2 */
2465/* C5.6.151 REV32 (sf==1, opcode==2) */
2466static void handle_rev32(DisasContext *s, unsigned int sf,
2467 unsigned int rn, unsigned int rd)
2468{
2469 TCGv_i64 tcg_rd, tcg_rn;
2470 tcg_rd = cpu_reg(s, rd);
2471 tcg_rn = cpu_reg(s, rn);
2472
2473 if (sf) {
2474 TCGv_i64 tcg_tmp = tcg_temp_new_i64();
2475 tcg_gen_andi_i64(tcg_tmp, tcg_rn, 0xffffffff);
2476 tcg_gen_bswap32_i64(tcg_rd, tcg_tmp);
2477 tcg_gen_shri_i64(tcg_tmp, tcg_rn, 32);
2478 tcg_gen_bswap32_i64(tcg_tmp, tcg_tmp);
2479 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 32, 32);
2480 tcg_temp_free_i64(tcg_tmp);
2481 } else {
2482 tcg_gen_ext32u_i64(tcg_rd, tcg_rn);
2483 tcg_gen_bswap32_i64(tcg_rd, tcg_rd);
2484 }
2485}
2486
2487/* C5.6.150 REV16 (opcode==1) */
2488static void handle_rev16(DisasContext *s, unsigned int sf,
2489 unsigned int rn, unsigned int rd)
2490{
2491 TCGv_i64 tcg_rd, tcg_rn, tcg_tmp;
2492 tcg_rd = cpu_reg(s, rd);
2493 tcg_rn = cpu_reg(s, rn);
2494
2495 tcg_tmp = tcg_temp_new_i64();
2496 tcg_gen_andi_i64(tcg_tmp, tcg_rn, 0xffff);
2497 tcg_gen_bswap16_i64(tcg_rd, tcg_tmp);
2498
2499 tcg_gen_shri_i64(tcg_tmp, tcg_rn, 16);
2500 tcg_gen_andi_i64(tcg_tmp, tcg_tmp, 0xffff);
2501 tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
2502 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 16, 16);
2503
2504 if (!sf) { /* done */
2505 tcg_temp_free_i64(tcg_tmp);
2506 return;
2507 }
2508
2509 tcg_gen_shri_i64(tcg_tmp, tcg_rn, 32);
2510 tcg_gen_andi_i64(tcg_tmp, tcg_tmp, 0xffff);
2511 tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
2512 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 32, 16);
2513
2514 tcg_gen_shri_i64(tcg_tmp, tcg_rn, 48);
2515 tcg_gen_bswap16_i64(tcg_tmp, tcg_tmp);
2516 tcg_gen_deposit_i64(tcg_rd, tcg_rd, tcg_tmp, 48, 16);
2517
2518 tcg_temp_free_i64(tcg_tmp);
2519}
2520
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002521/* C3.5.7 Data-processing (1 source) */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002522static void disas_data_proc_1src(DisasContext *s, uint32_t insn)
2523{
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002524 /*
2525 * 31 30 29 28 27 26 25 24 23 22 21 20 16 15 10 9 5 4 0
2526 * sf 1 S 1 1 0 1 0 1 1 0 opcode2 opcode Rn Rd
2527 * [0] [0 0 0 0 0]
2528 */
2529 unsigned int sf, opcode, rn, rd;
2530 if (extract32(insn, 16, 15) != 0x5ac0) {
2531 unallocated_encoding(s);
2532 return;
2533 }
2534 sf = insn & (1 << 31) ? 1 : 0;
2535 opcode = extract32(insn, 10, 6);
2536 rn = extract32(insn, 5, 5);
2537 rd = extract32(insn, 0, 5);
2538
2539 switch (opcode) {
2540 case 0: /* RBIT */
Claudio Fontana071b11d2013-12-03 15:12:20 +00002541 handle_rbit(s, sf, rn, rd);
2542 break;
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002543 case 1: /* REV16 */
Claudio Fontanacdd4f722013-12-03 15:12:20 +00002544 handle_rev16(s, sf, rn, rd);
2545 break;
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002546 case 2: /* REV32 */
Claudio Fontanacdd4f722013-12-03 15:12:20 +00002547 handle_rev32(s, sf, rn, rd);
2548 break;
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002549 case 3: /* REV64 */
Claudio Fontanacdd4f722013-12-03 15:12:20 +00002550 handle_rev64(s, sf, rn, rd);
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002551 break;
2552 case 4: /* CLZ */
2553 handle_clz(s, sf, rn, rd);
2554 break;
2555 case 5: /* CLS */
Claudio Fontanaded37772013-12-03 15:12:21 +00002556 handle_cls(s, sf, rn, rd);
Claudio Fontana4d3b1c32013-12-03 15:12:20 +00002557 break;
2558 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002559}
2560
Claudio Fontana11861fc2013-12-03 15:12:20 +00002561static void handle_div(DisasContext *s, bool is_signed, unsigned int sf,
2562 unsigned int rm, unsigned int rn, unsigned int rd)
2563{
2564 TCGv_i64 tcg_n, tcg_m, tcg_rd;
2565 tcg_n = tcg_temp_new_i64();
2566 tcg_m = tcg_temp_new_i64();
2567 tcg_rd = cpu_reg(s, rd);
2568
2569 if (!sf && is_signed) {
2570 tcg_gen_ext32s_i64(tcg_n, cpu_reg(s, rn));
2571 tcg_gen_ext32s_i64(tcg_m, cpu_reg(s, rm));
2572 } else {
2573 read_cpu_reg(s, tcg_n, rn, sf);
2574 read_cpu_reg(s, tcg_m, rm, sf);
2575 }
2576
2577 if (is_signed) {
2578 gen_helper_sdiv64(tcg_rd, tcg_n, tcg_m);
2579 } else {
2580 gen_helper_udiv64(tcg_rd, tcg_n, tcg_m);
2581 }
2582
2583 tcg_temp_free_i64(tcg_n);
2584 tcg_temp_free_i64(tcg_m);
2585
2586 if (!sf) { /* zero extend final result */
2587 tcg_gen_ext32u_i64(tcg_rd, tcg_rd);
2588 }
2589}
2590
Claudio Fontanae03cad52013-12-03 15:12:20 +00002591/* C5.6.115 LSLV, C5.6.118 LSRV, C5.6.17 ASRV, C5.6.154 RORV */
2592static void handle_shift_reg(DisasContext *s,
2593 enum a64_shift_type shift_type, unsigned int sf,
2594 unsigned int rm, unsigned int rn, unsigned int rd)
2595{
2596 TCGv_i64 tcg_shift = tcg_temp_new_i64();
2597 tcg_gen_andi_i64(tcg_shift, cpu_reg(s, rm), sf ? 63 : 31);
2598 shift_reg(cpu_reg(s, rd), cpu_reg(s, rn), sf, shift_type, tcg_shift);
2599 tcg_temp_free_i64(tcg_shift);
2600}
2601
Claudio Fontana11861fc2013-12-03 15:12:20 +00002602/* C3.5.8 Data-processing (2 source) */
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002603static void disas_data_proc_2src(DisasContext *s, uint32_t insn)
2604{
Claudio Fontana11861fc2013-12-03 15:12:20 +00002605 /*
2606 * 31 30 29 28 27 26 25 24 23 22 21 20 16 15 10 9 5 4 0
2607 * sf 0 S 1 1 0 1 0 1 1 0 Rm opcode Rn Rd
2608 * [0]
2609 */
2610 unsigned int sf, rm, opcode, rn, rd;
2611 sf = insn & (1 << 31) ? 1 : 0;
2612 rm = extract32(insn, 16, 5);
2613 opcode = extract32(insn, 10, 6);
2614 rn = extract32(insn, 5, 5);
2615 rd = extract32(insn, 0, 5);
2616
2617 if (extract32(insn, 21, 10) != 0x0d6) {
2618 unallocated_encoding(s);
2619 return;
2620 }
2621
2622 switch (opcode) {
2623 case 2: /* UDIV */
2624 handle_div(s, FALSE, sf, rm, rn, rd);
2625 break;
2626 case 3: /* SDIV */
2627 handle_div(s, TRUE, sf, rm, rn, rd);
2628 break;
2629 case 8: /* LSLV */
Claudio Fontanae03cad52013-12-03 15:12:20 +00002630 handle_shift_reg(s, A64_SHIFT_TYPE_LSL, sf, rm, rn, rd);
2631 break;
Claudio Fontana11861fc2013-12-03 15:12:20 +00002632 case 9: /* LSRV */
Claudio Fontanae03cad52013-12-03 15:12:20 +00002633 handle_shift_reg(s, A64_SHIFT_TYPE_LSR, sf, rm, rn, rd);
2634 break;
Claudio Fontana11861fc2013-12-03 15:12:20 +00002635 case 10: /* ASRV */
Claudio Fontanae03cad52013-12-03 15:12:20 +00002636 handle_shift_reg(s, A64_SHIFT_TYPE_ASR, sf, rm, rn, rd);
2637 break;
Claudio Fontana11861fc2013-12-03 15:12:20 +00002638 case 11: /* RORV */
Claudio Fontanae03cad52013-12-03 15:12:20 +00002639 handle_shift_reg(s, A64_SHIFT_TYPE_ROR, sf, rm, rn, rd);
2640 break;
Claudio Fontana11861fc2013-12-03 15:12:20 +00002641 case 16:
2642 case 17:
2643 case 18:
2644 case 19:
2645 case 20:
2646 case 21:
2647 case 22:
2648 case 23: /* CRC32 */
2649 unsupported_encoding(s, insn);
2650 break;
2651 default:
2652 unallocated_encoding(s);
2653 break;
2654 }
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002655}
2656
2657/* C3.5 Data processing - register */
2658static void disas_data_proc_reg(DisasContext *s, uint32_t insn)
2659{
2660 switch (extract32(insn, 24, 5)) {
2661 case 0x0a: /* Logical (shifted register) */
2662 disas_logic_reg(s, insn);
2663 break;
2664 case 0x0b: /* Add/subtract */
2665 if (insn & (1 << 21)) { /* (extended register) */
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002666 handle_add_sub_ext_reg(s, insn);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002667 } else {
Alex Bennéeffb7dab2013-12-03 10:52:22 +00002668 handle_add_sub_reg(s, insn);
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002669 }
2670 break;
2671 case 0x1b: /* Data-processing (3 source) */
2672 disas_data_proc_3src(s, insn);
2673 break;
2674 case 0x1a:
2675 switch (extract32(insn, 21, 3)) {
2676 case 0x0: /* Add/subtract (with carry) */
2677 disas_adc_sbc(s, insn);
2678 break;
2679 case 0x2: /* Conditional compare */
2680 if (insn & (1 << 11)) { /* (immediate) */
2681 disas_cc_imm(s, insn);
2682 } else { /* (register) */
2683 disas_cc_reg(s, insn);
2684 }
2685 break;
2686 case 0x4: /* Conditional select */
2687 disas_cond_select(s, insn);
2688 break;
2689 case 0x6: /* Data-processing */
2690 if (insn & (1 << 30)) { /* (1 source) */
2691 disas_data_proc_1src(s, insn);
2692 } else { /* (2 source) */
2693 disas_data_proc_2src(s, insn);
2694 }
2695 break;
2696 default:
2697 unallocated_encoding(s);
2698 break;
2699 }
2700 break;
2701 default:
2702 unallocated_encoding(s);
2703 break;
2704 }
2705}
2706
2707/* C3.6 Data processing - SIMD and floating point */
2708static void disas_data_proc_simd_fp(DisasContext *s, uint32_t insn)
2709{
2710 unsupported_encoding(s, insn);
2711}
2712
2713/* C3.1 A64 instruction index by encoding */
Peter Maydell089a8d92013-12-03 15:26:18 +00002714static void disas_a64_insn(CPUARMState *env, DisasContext *s)
Alexander Graf14ade102013-09-03 20:12:10 +01002715{
2716 uint32_t insn;
2717
2718 insn = arm_ldl_code(env, s->pc, s->bswap_code);
2719 s->insn = insn;
2720 s->pc += 4;
2721
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002722 switch (extract32(insn, 25, 4)) {
2723 case 0x0: case 0x1: case 0x2: case 0x3: /* UNALLOCATED */
Alexander Graf14ade102013-09-03 20:12:10 +01002724 unallocated_encoding(s);
2725 break;
Claudio Fontanaea5ca532013-12-03 15:12:18 +00002726 case 0x8: case 0x9: /* Data processing - immediate */
2727 disas_data_proc_imm(s, insn);
2728 break;
2729 case 0xa: case 0xb: /* Branch, exception generation and system insns */
2730 disas_b_exc_sys(s, insn);
2731 break;
2732 case 0x4:
2733 case 0x6:
2734 case 0xc:
2735 case 0xe: /* Loads and stores */
2736 disas_ldst(s, insn);
2737 break;
2738 case 0x5:
2739 case 0xd: /* Data processing - register */
2740 disas_data_proc_reg(s, insn);
2741 break;
2742 case 0x7:
2743 case 0xf: /* Data processing - SIMD and floating point */
2744 disas_data_proc_simd_fp(s, insn);
2745 break;
2746 default:
2747 assert(FALSE); /* all 15 cases should be handled above */
2748 break;
Alexander Graf14ade102013-09-03 20:12:10 +01002749 }
Alexander Grafeeed5002013-12-03 15:12:18 +00002750
2751 /* if we allocated any temporaries, free them here */
2752 free_tmp_a64(s);
Peter Maydell089a8d92013-12-03 15:26:18 +00002753}
Alexander Graf14ade102013-09-03 20:12:10 +01002754
Peter Maydell089a8d92013-12-03 15:26:18 +00002755void gen_intermediate_code_internal_a64(ARMCPU *cpu,
2756 TranslationBlock *tb,
2757 bool search_pc)
2758{
2759 CPUState *cs = CPU(cpu);
2760 CPUARMState *env = &cpu->env;
2761 DisasContext dc1, *dc = &dc1;
2762 CPUBreakpoint *bp;
2763 uint16_t *gen_opc_end;
2764 int j, lj;
2765 target_ulong pc_start;
2766 target_ulong next_page_start;
2767 int num_insns;
2768 int max_insns;
2769
2770 pc_start = tb->pc;
2771
2772 dc->tb = tb;
2773
2774 gen_opc_end = tcg_ctx.gen_opc_buf + OPC_MAX_SIZE;
2775
2776 dc->is_jmp = DISAS_NEXT;
2777 dc->pc = pc_start;
2778 dc->singlestep_enabled = cs->singlestep_enabled;
2779 dc->condjmp = 0;
2780
2781 dc->aarch64 = 1;
Alexander Grafeeed5002013-12-03 15:12:18 +00002782 dc->tmp_a64_count = 0;
Peter Maydell089a8d92013-12-03 15:26:18 +00002783 dc->thumb = 0;
2784 dc->bswap_code = 0;
2785 dc->condexec_mask = 0;
2786 dc->condexec_cond = 0;
2787#if !defined(CONFIG_USER_ONLY)
2788 dc->user = 0;
2789#endif
2790 dc->vfp_enabled = 0;
2791 dc->vec_len = 0;
2792 dc->vec_stride = 0;
2793
2794 next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
2795 lj = -1;
2796 num_insns = 0;
2797 max_insns = tb->cflags & CF_COUNT_MASK;
2798 if (max_insns == 0) {
2799 max_insns = CF_COUNT_MASK;
2800 }
2801
2802 gen_tb_start();
2803
2804 tcg_clear_temp_count();
2805
2806 do {
2807 if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
2808 QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
2809 if (bp->pc == dc->pc) {
2810 gen_exception_insn(dc, 0, EXCP_DEBUG);
2811 /* Advance PC so that clearing the breakpoint will
2812 invalidate this TB. */
2813 dc->pc += 2;
2814 goto done_generating;
2815 }
2816 }
2817 }
2818
2819 if (search_pc) {
2820 j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
2821 if (lj < j) {
2822 lj++;
2823 while (lj < j) {
2824 tcg_ctx.gen_opc_instr_start[lj++] = 0;
2825 }
2826 }
2827 tcg_ctx.gen_opc_pc[lj] = dc->pc;
2828 tcg_ctx.gen_opc_instr_start[lj] = 1;
2829 tcg_ctx.gen_opc_icount[lj] = num_insns;
2830 }
2831
2832 if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO)) {
2833 gen_io_start();
2834 }
2835
2836 if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP | CPU_LOG_TB_OP_OPT))) {
2837 tcg_gen_debug_insn_start(dc->pc);
2838 }
2839
2840 disas_a64_insn(env, dc);
2841
2842 if (tcg_check_temp_count()) {
2843 fprintf(stderr, "TCG temporary leak before "TARGET_FMT_lx"\n",
2844 dc->pc);
2845 }
2846
2847 /* Translation stops when a conditional branch is encountered.
2848 * Otherwise the subsequent code could get translated several times.
2849 * Also stop translation when a page boundary is reached. This
2850 * ensures prefetch aborts occur at the right place.
2851 */
2852 num_insns++;
2853 } while (!dc->is_jmp && tcg_ctx.gen_opc_ptr < gen_opc_end &&
2854 !cs->singlestep_enabled &&
2855 !singlestep &&
2856 dc->pc < next_page_start &&
2857 num_insns < max_insns);
2858
2859 if (tb->cflags & CF_LAST_IO) {
2860 gen_io_end();
2861 }
2862
2863 if (unlikely(cs->singlestep_enabled) && dc->is_jmp != DISAS_EXC) {
2864 /* Note that this means single stepping WFI doesn't halt the CPU.
2865 * For conditional branch insns this is harmless unreachable code as
2866 * gen_goto_tb() has already handled emitting the debug exception
2867 * (and thus a tb-jump is not possible when singlestepping).
2868 */
2869 assert(dc->is_jmp != DISAS_TB_JUMP);
2870 if (dc->is_jmp != DISAS_JUMP) {
2871 gen_a64_set_pc_im(dc->pc);
2872 }
2873 gen_exception(EXCP_DEBUG);
2874 } else {
2875 switch (dc->is_jmp) {
2876 case DISAS_NEXT:
2877 gen_goto_tb(dc, 1, dc->pc);
2878 break;
2879 default:
2880 case DISAS_JUMP:
2881 case DISAS_UPDATE:
2882 /* indicate that the hash table must be used to find the next TB */
2883 tcg_gen_exit_tb(0);
2884 break;
2885 case DISAS_TB_JUMP:
2886 case DISAS_EXC:
2887 case DISAS_SWI:
2888 break;
2889 case DISAS_WFI:
2890 /* This is a special case because we don't want to just halt the CPU
2891 * if trying to debug across a WFI.
2892 */
2893 gen_helper_wfi(cpu_env);
2894 break;
2895 }
2896 }
2897
2898done_generating:
2899 gen_tb_end(tb, num_insns);
2900 *tcg_ctx.gen_opc_ptr = INDEX_op_end;
2901
2902#ifdef DEBUG_DISAS
2903 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
2904 qemu_log("----------------\n");
2905 qemu_log("IN: %s\n", lookup_symbol(pc_start));
2906 log_target_disas(env, pc_start, dc->pc - pc_start,
2907 dc->thumb | (dc->bswap_code << 1));
2908 qemu_log("\n");
2909 }
2910#endif
2911 if (search_pc) {
2912 j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
2913 lj++;
2914 while (lj <= j) {
2915 tcg_ctx.gen_opc_instr_start[lj++] = 0;
2916 }
2917 } else {
2918 tb->size = dc->pc - pc_start;
2919 tb->icount = num_insns;
Alexander Graf14ade102013-09-03 20:12:10 +01002920 }
2921}