Statistics
| Branch: | Revision:

root / target-arm / translate.c @ 30a8cac1

History | View | Annotate | Download (312.3 kB)

1 2c0262af bellard
/*
2 2c0262af bellard
 *  ARM translation
3 5fafdf24 ths
 *
4 2c0262af bellard
 *  Copyright (c) 2003 Fabrice Bellard
5 9ee6e8bb pbrook
 *  Copyright (c) 2005-2007 CodeSourcery
6 18c9b560 balrog
 *  Copyright (c) 2007 OpenedHand, Ltd.
7 2c0262af bellard
 *
8 2c0262af bellard
 * This library is free software; you can redistribute it and/or
9 2c0262af bellard
 * modify it under the terms of the GNU Lesser General Public
10 2c0262af bellard
 * License as published by the Free Software Foundation; either
11 2c0262af bellard
 * version 2 of the License, or (at your option) any later version.
12 2c0262af bellard
 *
13 2c0262af bellard
 * This library is distributed in the hope that it will be useful,
14 2c0262af bellard
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 2c0262af bellard
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16 2c0262af bellard
 * Lesser General Public License for more details.
17 2c0262af bellard
 *
18 2c0262af bellard
 * You should have received a copy of the GNU Lesser General Public
19 8167ee88 Blue Swirl
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
20 2c0262af bellard
 */
21 2c0262af bellard
#include <stdarg.h>
22 2c0262af bellard
#include <stdlib.h>
23 2c0262af bellard
#include <stdio.h>
24 2c0262af bellard
#include <string.h>
25 2c0262af bellard
#include <inttypes.h>
26 2c0262af bellard
27 2c0262af bellard
#include "cpu.h"
28 2c0262af bellard
#include "exec-all.h"
29 2c0262af bellard
#include "disas.h"
30 57fec1fe bellard
#include "tcg-op.h"
31 79383c9c blueswir1
#include "qemu-log.h"
32 1497c961 pbrook
33 a7812ae4 pbrook
#include "helpers.h"
34 1497c961 pbrook
#define GEN_HELPER 1
35 b26eefb6 pbrook
#include "helpers.h"
36 2c0262af bellard
37 9ee6e8bb pbrook
#define ENABLE_ARCH_5J    0
38 9ee6e8bb pbrook
#define ENABLE_ARCH_6     arm_feature(env, ARM_FEATURE_V6)
39 9ee6e8bb pbrook
#define ENABLE_ARCH_6K   arm_feature(env, ARM_FEATURE_V6K)
40 9ee6e8bb pbrook
#define ENABLE_ARCH_6T2   arm_feature(env, ARM_FEATURE_THUMB2)
41 9ee6e8bb pbrook
#define ENABLE_ARCH_7     arm_feature(env, ARM_FEATURE_V7)
42 b5ff1b31 bellard
43 86753403 pbrook
#define ARCH(x) do { if (!ENABLE_ARCH_##x) goto illegal_op; } while(0)
44 b5ff1b31 bellard
45 2c0262af bellard
/* internal defines */
46 2c0262af bellard
typedef struct DisasContext {
47 0fa85d43 bellard
    target_ulong pc;
48 2c0262af bellard
    int is_jmp;
49 e50e6a20 bellard
    /* Nonzero if this instruction has been conditionally skipped.  */
50 e50e6a20 bellard
    int condjmp;
51 e50e6a20 bellard
    /* The label that will be jumped to when the instruction is skipped.  */
52 e50e6a20 bellard
    int condlabel;
53 9ee6e8bb pbrook
    /* Thumb-2 condtional execution bits.  */
54 9ee6e8bb pbrook
    int condexec_mask;
55 9ee6e8bb pbrook
    int condexec_cond;
56 2c0262af bellard
    struct TranslationBlock *tb;
57 8aaca4c0 bellard
    int singlestep_enabled;
58 5899f386 bellard
    int thumb;
59 b5ff1b31 bellard
#if !defined(CONFIG_USER_ONLY)
60 b5ff1b31 bellard
    int user;
61 b5ff1b31 bellard
#endif
62 2c0262af bellard
} DisasContext;
63 2c0262af bellard
64 b5ff1b31 bellard
#if defined(CONFIG_USER_ONLY)
65 b5ff1b31 bellard
#define IS_USER(s) 1
66 b5ff1b31 bellard
#else
67 b5ff1b31 bellard
#define IS_USER(s) (s->user)
68 b5ff1b31 bellard
#endif
69 b5ff1b31 bellard
70 9ee6e8bb pbrook
/* These instructions trap after executing, so defer them until after the
71 9ee6e8bb pbrook
   conditional executions state has been updated.  */
72 9ee6e8bb pbrook
#define DISAS_WFI 4
73 9ee6e8bb pbrook
#define DISAS_SWI 5
74 2c0262af bellard
75 a7812ae4 pbrook
static TCGv_ptr cpu_env;
76 ad69471c pbrook
/* We reuse the same 64-bit temporaries for efficiency.  */
77 a7812ae4 pbrook
static TCGv_i64 cpu_V0, cpu_V1, cpu_M0;
78 155c3eac Filip Navara
static TCGv_i32 cpu_R[16];
79 426f5abc Paul Brook
static TCGv_i32 cpu_exclusive_addr;
80 426f5abc Paul Brook
static TCGv_i32 cpu_exclusive_val;
81 426f5abc Paul Brook
static TCGv_i32 cpu_exclusive_high;
82 426f5abc Paul Brook
#ifdef CONFIG_USER_ONLY
83 426f5abc Paul Brook
static TCGv_i32 cpu_exclusive_test;
84 426f5abc Paul Brook
static TCGv_i32 cpu_exclusive_info;
85 426f5abc Paul Brook
#endif
86 ad69471c pbrook
87 b26eefb6 pbrook
/* FIXME:  These should be removed.  */
88 a7812ae4 pbrook
static TCGv cpu_F0s, cpu_F1s;
89 a7812ae4 pbrook
static TCGv_i64 cpu_F0d, cpu_F1d;
90 b26eefb6 pbrook
91 2e70f6ef pbrook
#include "gen-icount.h"
92 2e70f6ef pbrook
93 155c3eac Filip Navara
static const char *regnames[] =
94 155c3eac Filip Navara
    { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
95 155c3eac Filip Navara
      "r8", "r9", "r10", "r11", "r12", "r13", "r14", "pc" };
96 155c3eac Filip Navara
97 b26eefb6 pbrook
/* initialize TCG globals.  */
98 b26eefb6 pbrook
void arm_translate_init(void)
99 b26eefb6 pbrook
{
100 155c3eac Filip Navara
    int i;
101 155c3eac Filip Navara
102 a7812ae4 pbrook
    cpu_env = tcg_global_reg_new_ptr(TCG_AREG0, "env");
103 a7812ae4 pbrook
104 155c3eac Filip Navara
    for (i = 0; i < 16; i++) {
105 155c3eac Filip Navara
        cpu_R[i] = tcg_global_mem_new_i32(TCG_AREG0,
106 155c3eac Filip Navara
                                          offsetof(CPUState, regs[i]),
107 155c3eac Filip Navara
                                          regnames[i]);
108 155c3eac Filip Navara
    }
109 426f5abc Paul Brook
    cpu_exclusive_addr = tcg_global_mem_new_i32(TCG_AREG0,
110 426f5abc Paul Brook
        offsetof(CPUState, exclusive_addr), "exclusive_addr");
111 426f5abc Paul Brook
    cpu_exclusive_val = tcg_global_mem_new_i32(TCG_AREG0,
112 426f5abc Paul Brook
        offsetof(CPUState, exclusive_val), "exclusive_val");
113 426f5abc Paul Brook
    cpu_exclusive_high = tcg_global_mem_new_i32(TCG_AREG0,
114 426f5abc Paul Brook
        offsetof(CPUState, exclusive_high), "exclusive_high");
115 426f5abc Paul Brook
#ifdef CONFIG_USER_ONLY
116 426f5abc Paul Brook
    cpu_exclusive_test = tcg_global_mem_new_i32(TCG_AREG0,
117 426f5abc Paul Brook
        offsetof(CPUState, exclusive_test), "exclusive_test");
118 426f5abc Paul Brook
    cpu_exclusive_info = tcg_global_mem_new_i32(TCG_AREG0,
119 426f5abc Paul Brook
        offsetof(CPUState, exclusive_info), "exclusive_info");
120 426f5abc Paul Brook
#endif
121 155c3eac Filip Navara
122 a7812ae4 pbrook
#define GEN_HELPER 2
123 a7812ae4 pbrook
#include "helpers.h"
124 b26eefb6 pbrook
}
125 b26eefb6 pbrook
126 b26eefb6 pbrook
static int num_temps;
127 b26eefb6 pbrook
128 b26eefb6 pbrook
/* Allocate a temporary variable.  */
129 a7812ae4 pbrook
static TCGv_i32 new_tmp(void)
130 b26eefb6 pbrook
{
131 12edd4f2 Filip Navara
    num_temps++;
132 12edd4f2 Filip Navara
    return tcg_temp_new_i32();
133 b26eefb6 pbrook
}
134 b26eefb6 pbrook
135 b26eefb6 pbrook
/* Release a temporary variable.  */
136 b26eefb6 pbrook
static void dead_tmp(TCGv tmp)
137 b26eefb6 pbrook
{
138 12edd4f2 Filip Navara
    tcg_temp_free(tmp);
139 b26eefb6 pbrook
    num_temps--;
140 b26eefb6 pbrook
}
141 b26eefb6 pbrook
142 d9ba4830 pbrook
static inline TCGv load_cpu_offset(int offset)
143 d9ba4830 pbrook
{
144 d9ba4830 pbrook
    TCGv tmp = new_tmp();
145 d9ba4830 pbrook
    tcg_gen_ld_i32(tmp, cpu_env, offset);
146 d9ba4830 pbrook
    return tmp;
147 d9ba4830 pbrook
}
148 d9ba4830 pbrook
149 d9ba4830 pbrook
#define load_cpu_field(name) load_cpu_offset(offsetof(CPUState, name))
150 d9ba4830 pbrook
151 d9ba4830 pbrook
static inline void store_cpu_offset(TCGv var, int offset)
152 d9ba4830 pbrook
{
153 d9ba4830 pbrook
    tcg_gen_st_i32(var, cpu_env, offset);
154 d9ba4830 pbrook
    dead_tmp(var);
155 d9ba4830 pbrook
}
156 d9ba4830 pbrook
157 d9ba4830 pbrook
#define store_cpu_field(var, name) \
158 d9ba4830 pbrook
    store_cpu_offset(var, offsetof(CPUState, name))
159 d9ba4830 pbrook
160 b26eefb6 pbrook
/* Set a variable to the value of a CPU register.  */
161 b26eefb6 pbrook
static void load_reg_var(DisasContext *s, TCGv var, int reg)
162 b26eefb6 pbrook
{
163 b26eefb6 pbrook
    if (reg == 15) {
164 b26eefb6 pbrook
        uint32_t addr;
165 b26eefb6 pbrook
        /* normaly, since we updated PC, we need only to add one insn */
166 b26eefb6 pbrook
        if (s->thumb)
167 b26eefb6 pbrook
            addr = (long)s->pc + 2;
168 b26eefb6 pbrook
        else
169 b26eefb6 pbrook
            addr = (long)s->pc + 4;
170 b26eefb6 pbrook
        tcg_gen_movi_i32(var, addr);
171 b26eefb6 pbrook
    } else {
172 155c3eac Filip Navara
        tcg_gen_mov_i32(var, cpu_R[reg]);
173 b26eefb6 pbrook
    }
174 b26eefb6 pbrook
}
175 b26eefb6 pbrook
176 b26eefb6 pbrook
/* Create a new temporary and set it to the value of a CPU register.  */
177 b26eefb6 pbrook
static inline TCGv load_reg(DisasContext *s, int reg)
178 b26eefb6 pbrook
{
179 b26eefb6 pbrook
    TCGv tmp = new_tmp();
180 b26eefb6 pbrook
    load_reg_var(s, tmp, reg);
181 b26eefb6 pbrook
    return tmp;
182 b26eefb6 pbrook
}
183 b26eefb6 pbrook
184 b26eefb6 pbrook
/* Set a CPU register.  The source must be a temporary and will be
185 b26eefb6 pbrook
   marked as dead.  */
186 b26eefb6 pbrook
static void store_reg(DisasContext *s, int reg, TCGv var)
187 b26eefb6 pbrook
{
188 b26eefb6 pbrook
    if (reg == 15) {
189 b26eefb6 pbrook
        tcg_gen_andi_i32(var, var, ~1);
190 b26eefb6 pbrook
        s->is_jmp = DISAS_JUMP;
191 b26eefb6 pbrook
    }
192 155c3eac Filip Navara
    tcg_gen_mov_i32(cpu_R[reg], var);
193 b26eefb6 pbrook
    dead_tmp(var);
194 b26eefb6 pbrook
}
195 b26eefb6 pbrook
196 b26eefb6 pbrook
/* Value extensions.  */
197 86831435 pbrook
#define gen_uxtb(var) tcg_gen_ext8u_i32(var, var)
198 86831435 pbrook
#define gen_uxth(var) tcg_gen_ext16u_i32(var, var)
199 b26eefb6 pbrook
#define gen_sxtb(var) tcg_gen_ext8s_i32(var, var)
200 b26eefb6 pbrook
#define gen_sxth(var) tcg_gen_ext16s_i32(var, var)
201 b26eefb6 pbrook
202 1497c961 pbrook
#define gen_sxtb16(var) gen_helper_sxtb16(var, var)
203 1497c961 pbrook
#define gen_uxtb16(var) gen_helper_uxtb16(var, var)
204 8f01245e pbrook
205 b26eefb6 pbrook
206 b75263d6 Juha Riihimรคki
static inline void gen_set_cpsr(TCGv var, uint32_t mask)
207 b75263d6 Juha Riihimรคki
{
208 b75263d6 Juha Riihimรคki
    TCGv tmp_mask = tcg_const_i32(mask);
209 b75263d6 Juha Riihimรคki
    gen_helper_cpsr_write(var, tmp_mask);
210 b75263d6 Juha Riihimรคki
    tcg_temp_free_i32(tmp_mask);
211 b75263d6 Juha Riihimรคki
}
212 d9ba4830 pbrook
/* Set NZCV flags from the high 4 bits of var.  */
213 d9ba4830 pbrook
#define gen_set_nzcv(var) gen_set_cpsr(var, CPSR_NZCV)
214 d9ba4830 pbrook
215 d9ba4830 pbrook
static void gen_exception(int excp)
216 d9ba4830 pbrook
{
217 d9ba4830 pbrook
    TCGv tmp = new_tmp();
218 d9ba4830 pbrook
    tcg_gen_movi_i32(tmp, excp);
219 d9ba4830 pbrook
    gen_helper_exception(tmp);
220 d9ba4830 pbrook
    dead_tmp(tmp);
221 d9ba4830 pbrook
}
222 d9ba4830 pbrook
223 3670669c pbrook
static void gen_smul_dual(TCGv a, TCGv b)
224 3670669c pbrook
{
225 3670669c pbrook
    TCGv tmp1 = new_tmp();
226 3670669c pbrook
    TCGv tmp2 = new_tmp();
227 22478e79 balrog
    tcg_gen_ext16s_i32(tmp1, a);
228 22478e79 balrog
    tcg_gen_ext16s_i32(tmp2, b);
229 3670669c pbrook
    tcg_gen_mul_i32(tmp1, tmp1, tmp2);
230 3670669c pbrook
    dead_tmp(tmp2);
231 3670669c pbrook
    tcg_gen_sari_i32(a, a, 16);
232 3670669c pbrook
    tcg_gen_sari_i32(b, b, 16);
233 3670669c pbrook
    tcg_gen_mul_i32(b, b, a);
234 3670669c pbrook
    tcg_gen_mov_i32(a, tmp1);
235 3670669c pbrook
    dead_tmp(tmp1);
236 3670669c pbrook
}
237 3670669c pbrook
238 3670669c pbrook
/* Byteswap each halfword.  */
239 3670669c pbrook
static void gen_rev16(TCGv var)
240 3670669c pbrook
{
241 3670669c pbrook
    TCGv tmp = new_tmp();
242 3670669c pbrook
    tcg_gen_shri_i32(tmp, var, 8);
243 3670669c pbrook
    tcg_gen_andi_i32(tmp, tmp, 0x00ff00ff);
244 3670669c pbrook
    tcg_gen_shli_i32(var, var, 8);
245 3670669c pbrook
    tcg_gen_andi_i32(var, var, 0xff00ff00);
246 3670669c pbrook
    tcg_gen_or_i32(var, var, tmp);
247 3670669c pbrook
    dead_tmp(tmp);
248 3670669c pbrook
}
249 3670669c pbrook
250 3670669c pbrook
/* Byteswap low halfword and sign extend.  */
251 3670669c pbrook
static void gen_revsh(TCGv var)
252 3670669c pbrook
{
253 3670669c pbrook
    TCGv tmp = new_tmp();
254 3670669c pbrook
    tcg_gen_shri_i32(tmp, var, 8);
255 3670669c pbrook
    tcg_gen_andi_i32(tmp, tmp, 0x00ff);
256 3670669c pbrook
    tcg_gen_shli_i32(var, var, 8);
257 3670669c pbrook
    tcg_gen_ext8s_i32(var, var);
258 3670669c pbrook
    tcg_gen_or_i32(var, var, tmp);
259 3670669c pbrook
    dead_tmp(tmp);
260 3670669c pbrook
}
261 3670669c pbrook
262 3670669c pbrook
/* Unsigned bitfield extract.  */
263 3670669c pbrook
static void gen_ubfx(TCGv var, int shift, uint32_t mask)
264 3670669c pbrook
{
265 3670669c pbrook
    if (shift)
266 3670669c pbrook
        tcg_gen_shri_i32(var, var, shift);
267 3670669c pbrook
    tcg_gen_andi_i32(var, var, mask);
268 3670669c pbrook
}
269 3670669c pbrook
270 3670669c pbrook
/* Signed bitfield extract.  */
271 3670669c pbrook
static void gen_sbfx(TCGv var, int shift, int width)
272 3670669c pbrook
{
273 3670669c pbrook
    uint32_t signbit;
274 3670669c pbrook
275 3670669c pbrook
    if (shift)
276 3670669c pbrook
        tcg_gen_sari_i32(var, var, shift);
277 3670669c pbrook
    if (shift + width < 32) {
278 3670669c pbrook
        signbit = 1u << (width - 1);
279 3670669c pbrook
        tcg_gen_andi_i32(var, var, (1u << width) - 1);
280 3670669c pbrook
        tcg_gen_xori_i32(var, var, signbit);
281 3670669c pbrook
        tcg_gen_subi_i32(var, var, signbit);
282 3670669c pbrook
    }
283 3670669c pbrook
}
284 3670669c pbrook
285 3670669c pbrook
/* Bitfield insertion.  Insert val into base.  Clobbers base and val.  */
286 3670669c pbrook
static void gen_bfi(TCGv dest, TCGv base, TCGv val, int shift, uint32_t mask)
287 3670669c pbrook
{
288 3670669c pbrook
    tcg_gen_andi_i32(val, val, mask);
289 8f8e3aa4 pbrook
    tcg_gen_shli_i32(val, val, shift);
290 8f8e3aa4 pbrook
    tcg_gen_andi_i32(base, base, ~(mask << shift));
291 3670669c pbrook
    tcg_gen_or_i32(dest, base, val);
292 3670669c pbrook
}
293 3670669c pbrook
294 d9ba4830 pbrook
/* Round the top 32 bits of a 64-bit value.  */
295 d9ba4830 pbrook
static void gen_roundqd(TCGv a, TCGv b)
296 3670669c pbrook
{
297 d9ba4830 pbrook
    tcg_gen_shri_i32(a, a, 31);
298 d9ba4830 pbrook
    tcg_gen_add_i32(a, a, b);
299 3670669c pbrook
}
300 3670669c pbrook
301 8f01245e pbrook
/* FIXME: Most targets have native widening multiplication.
302 8f01245e pbrook
   It would be good to use that instead of a full wide multiply.  */
303 5e3f878a pbrook
/* 32x32->64 multiply.  Marks inputs as dead.  */
304 a7812ae4 pbrook
static TCGv_i64 gen_mulu_i64_i32(TCGv a, TCGv b)
305 5e3f878a pbrook
{
306 a7812ae4 pbrook
    TCGv_i64 tmp1 = tcg_temp_new_i64();
307 a7812ae4 pbrook
    TCGv_i64 tmp2 = tcg_temp_new_i64();
308 5e3f878a pbrook
309 5e3f878a pbrook
    tcg_gen_extu_i32_i64(tmp1, a);
310 5e3f878a pbrook
    dead_tmp(a);
311 5e3f878a pbrook
    tcg_gen_extu_i32_i64(tmp2, b);
312 5e3f878a pbrook
    dead_tmp(b);
313 5e3f878a pbrook
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
314 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp2);
315 5e3f878a pbrook
    return tmp1;
316 5e3f878a pbrook
}
317 5e3f878a pbrook
318 a7812ae4 pbrook
static TCGv_i64 gen_muls_i64_i32(TCGv a, TCGv b)
319 5e3f878a pbrook
{
320 a7812ae4 pbrook
    TCGv_i64 tmp1 = tcg_temp_new_i64();
321 a7812ae4 pbrook
    TCGv_i64 tmp2 = tcg_temp_new_i64();
322 5e3f878a pbrook
323 5e3f878a pbrook
    tcg_gen_ext_i32_i64(tmp1, a);
324 5e3f878a pbrook
    dead_tmp(a);
325 5e3f878a pbrook
    tcg_gen_ext_i32_i64(tmp2, b);
326 5e3f878a pbrook
    dead_tmp(b);
327 5e3f878a pbrook
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
328 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp2);
329 5e3f878a pbrook
    return tmp1;
330 5e3f878a pbrook
}
331 5e3f878a pbrook
332 8f01245e pbrook
/* Signed 32x32->64 multiply.  */
333 d9ba4830 pbrook
static void gen_imull(TCGv a, TCGv b)
334 8f01245e pbrook
{
335 a7812ae4 pbrook
    TCGv_i64 tmp1 = tcg_temp_new_i64();
336 a7812ae4 pbrook
    TCGv_i64 tmp2 = tcg_temp_new_i64();
337 8f01245e pbrook
338 d9ba4830 pbrook
    tcg_gen_ext_i32_i64(tmp1, a);
339 d9ba4830 pbrook
    tcg_gen_ext_i32_i64(tmp2, b);
340 8f01245e pbrook
    tcg_gen_mul_i64(tmp1, tmp1, tmp2);
341 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp2);
342 d9ba4830 pbrook
    tcg_gen_trunc_i64_i32(a, tmp1);
343 8f01245e pbrook
    tcg_gen_shri_i64(tmp1, tmp1, 32);
344 d9ba4830 pbrook
    tcg_gen_trunc_i64_i32(b, tmp1);
345 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp1);
346 d9ba4830 pbrook
}
347 d9ba4830 pbrook
348 8f01245e pbrook
/* Swap low and high halfwords.  */
349 8f01245e pbrook
static void gen_swap_half(TCGv var)
350 8f01245e pbrook
{
351 8f01245e pbrook
    TCGv tmp = new_tmp();
352 8f01245e pbrook
    tcg_gen_shri_i32(tmp, var, 16);
353 8f01245e pbrook
    tcg_gen_shli_i32(var, var, 16);
354 8f01245e pbrook
    tcg_gen_or_i32(var, var, tmp);
355 3670669c pbrook
    dead_tmp(tmp);
356 8f01245e pbrook
}
357 8f01245e pbrook
358 b26eefb6 pbrook
/* Dual 16-bit add.  Result placed in t0 and t1 is marked as dead.
359 b26eefb6 pbrook
    tmp = (t0 ^ t1) & 0x8000;
360 b26eefb6 pbrook
    t0 &= ~0x8000;
361 b26eefb6 pbrook
    t1 &= ~0x8000;
362 b26eefb6 pbrook
    t0 = (t0 + t1) ^ tmp;
363 b26eefb6 pbrook
 */
364 b26eefb6 pbrook
365 b26eefb6 pbrook
static void gen_add16(TCGv t0, TCGv t1)
366 b26eefb6 pbrook
{
367 b26eefb6 pbrook
    TCGv tmp = new_tmp();
368 b26eefb6 pbrook
    tcg_gen_xor_i32(tmp, t0, t1);
369 b26eefb6 pbrook
    tcg_gen_andi_i32(tmp, tmp, 0x8000);
370 b26eefb6 pbrook
    tcg_gen_andi_i32(t0, t0, ~0x8000);
371 b26eefb6 pbrook
    tcg_gen_andi_i32(t1, t1, ~0x8000);
372 b26eefb6 pbrook
    tcg_gen_add_i32(t0, t0, t1);
373 b26eefb6 pbrook
    tcg_gen_xor_i32(t0, t0, tmp);
374 b26eefb6 pbrook
    dead_tmp(tmp);
375 b26eefb6 pbrook
    dead_tmp(t1);
376 b26eefb6 pbrook
}
377 b26eefb6 pbrook
378 9a119ff6 pbrook
#define gen_set_CF(var) tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, CF))
379 9a119ff6 pbrook
380 b26eefb6 pbrook
/* Set CF to the top bit of var.  */
381 b26eefb6 pbrook
static void gen_set_CF_bit31(TCGv var)
382 b26eefb6 pbrook
{
383 b26eefb6 pbrook
    TCGv tmp = new_tmp();
384 b26eefb6 pbrook
    tcg_gen_shri_i32(tmp, var, 31);
385 4cc633c3 balrog
    gen_set_CF(tmp);
386 b26eefb6 pbrook
    dead_tmp(tmp);
387 b26eefb6 pbrook
}
388 b26eefb6 pbrook
389 b26eefb6 pbrook
/* Set N and Z flags from var.  */
390 b26eefb6 pbrook
static inline void gen_logic_CC(TCGv var)
391 b26eefb6 pbrook
{
392 6fbe23d5 pbrook
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, NF));
393 6fbe23d5 pbrook
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, ZF));
394 b26eefb6 pbrook
}
395 b26eefb6 pbrook
396 b26eefb6 pbrook
/* T0 += T1 + CF.  */
397 396e467c Filip Navara
static void gen_adc(TCGv t0, TCGv t1)
398 b26eefb6 pbrook
{
399 d9ba4830 pbrook
    TCGv tmp;
400 396e467c Filip Navara
    tcg_gen_add_i32(t0, t0, t1);
401 d9ba4830 pbrook
    tmp = load_cpu_field(CF);
402 396e467c Filip Navara
    tcg_gen_add_i32(t0, t0, tmp);
403 b26eefb6 pbrook
    dead_tmp(tmp);
404 b26eefb6 pbrook
}
405 b26eefb6 pbrook
406 e9bb4aa9 Juha Riihimรคki
/* dest = T0 + T1 + CF. */
407 e9bb4aa9 Juha Riihimรคki
static void gen_add_carry(TCGv dest, TCGv t0, TCGv t1)
408 e9bb4aa9 Juha Riihimรคki
{
409 e9bb4aa9 Juha Riihimรคki
    TCGv tmp;
410 e9bb4aa9 Juha Riihimรคki
    tcg_gen_add_i32(dest, t0, t1);
411 e9bb4aa9 Juha Riihimรคki
    tmp = load_cpu_field(CF);
412 e9bb4aa9 Juha Riihimรคki
    tcg_gen_add_i32(dest, dest, tmp);
413 e9bb4aa9 Juha Riihimรคki
    dead_tmp(tmp);
414 e9bb4aa9 Juha Riihimรคki
}
415 e9bb4aa9 Juha Riihimรคki
416 3670669c pbrook
/* dest = T0 - T1 + CF - 1.  */
417 3670669c pbrook
static void gen_sub_carry(TCGv dest, TCGv t0, TCGv t1)
418 3670669c pbrook
{
419 d9ba4830 pbrook
    TCGv tmp;
420 3670669c pbrook
    tcg_gen_sub_i32(dest, t0, t1);
421 d9ba4830 pbrook
    tmp = load_cpu_field(CF);
422 3670669c pbrook
    tcg_gen_add_i32(dest, dest, tmp);
423 3670669c pbrook
    tcg_gen_subi_i32(dest, dest, 1);
424 3670669c pbrook
    dead_tmp(tmp);
425 3670669c pbrook
}
426 3670669c pbrook
427 b26eefb6 pbrook
/* FIXME:  Implement this natively.  */
428 ad69471c pbrook
#define tcg_gen_abs_i32(t0, t1) gen_helper_abs(t0, t1)
429 ad69471c pbrook
430 9a119ff6 pbrook
static void shifter_out_im(TCGv var, int shift)
431 b26eefb6 pbrook
{
432 9a119ff6 pbrook
    TCGv tmp = new_tmp();
433 9a119ff6 pbrook
    if (shift == 0) {
434 9a119ff6 pbrook
        tcg_gen_andi_i32(tmp, var, 1);
435 b26eefb6 pbrook
    } else {
436 9a119ff6 pbrook
        tcg_gen_shri_i32(tmp, var, shift);
437 4cc633c3 balrog
        if (shift != 31)
438 9a119ff6 pbrook
            tcg_gen_andi_i32(tmp, tmp, 1);
439 9a119ff6 pbrook
    }
440 9a119ff6 pbrook
    gen_set_CF(tmp);
441 9a119ff6 pbrook
    dead_tmp(tmp);
442 9a119ff6 pbrook
}
443 b26eefb6 pbrook
444 9a119ff6 pbrook
/* Shift by immediate.  Includes special handling for shift == 0.  */
445 9a119ff6 pbrook
static inline void gen_arm_shift_im(TCGv var, int shiftop, int shift, int flags)
446 9a119ff6 pbrook
{
447 9a119ff6 pbrook
    switch (shiftop) {
448 9a119ff6 pbrook
    case 0: /* LSL */
449 9a119ff6 pbrook
        if (shift != 0) {
450 9a119ff6 pbrook
            if (flags)
451 9a119ff6 pbrook
                shifter_out_im(var, 32 - shift);
452 9a119ff6 pbrook
            tcg_gen_shli_i32(var, var, shift);
453 9a119ff6 pbrook
        }
454 9a119ff6 pbrook
        break;
455 9a119ff6 pbrook
    case 1: /* LSR */
456 9a119ff6 pbrook
        if (shift == 0) {
457 9a119ff6 pbrook
            if (flags) {
458 9a119ff6 pbrook
                tcg_gen_shri_i32(var, var, 31);
459 9a119ff6 pbrook
                gen_set_CF(var);
460 9a119ff6 pbrook
            }
461 9a119ff6 pbrook
            tcg_gen_movi_i32(var, 0);
462 9a119ff6 pbrook
        } else {
463 9a119ff6 pbrook
            if (flags)
464 9a119ff6 pbrook
                shifter_out_im(var, shift - 1);
465 9a119ff6 pbrook
            tcg_gen_shri_i32(var, var, shift);
466 9a119ff6 pbrook
        }
467 9a119ff6 pbrook
        break;
468 9a119ff6 pbrook
    case 2: /* ASR */
469 9a119ff6 pbrook
        if (shift == 0)
470 9a119ff6 pbrook
            shift = 32;
471 9a119ff6 pbrook
        if (flags)
472 9a119ff6 pbrook
            shifter_out_im(var, shift - 1);
473 9a119ff6 pbrook
        if (shift == 32)
474 9a119ff6 pbrook
          shift = 31;
475 9a119ff6 pbrook
        tcg_gen_sari_i32(var, var, shift);
476 9a119ff6 pbrook
        break;
477 9a119ff6 pbrook
    case 3: /* ROR/RRX */
478 9a119ff6 pbrook
        if (shift != 0) {
479 9a119ff6 pbrook
            if (flags)
480 9a119ff6 pbrook
                shifter_out_im(var, shift - 1);
481 f669df27 Aurelien Jarno
            tcg_gen_rotri_i32(var, var, shift); break;
482 9a119ff6 pbrook
        } else {
483 d9ba4830 pbrook
            TCGv tmp = load_cpu_field(CF);
484 9a119ff6 pbrook
            if (flags)
485 9a119ff6 pbrook
                shifter_out_im(var, 0);
486 9a119ff6 pbrook
            tcg_gen_shri_i32(var, var, 1);
487 b26eefb6 pbrook
            tcg_gen_shli_i32(tmp, tmp, 31);
488 b26eefb6 pbrook
            tcg_gen_or_i32(var, var, tmp);
489 b26eefb6 pbrook
            dead_tmp(tmp);
490 b26eefb6 pbrook
        }
491 b26eefb6 pbrook
    }
492 b26eefb6 pbrook
};
493 b26eefb6 pbrook
494 8984bd2e pbrook
static inline void gen_arm_shift_reg(TCGv var, int shiftop,
495 8984bd2e pbrook
                                     TCGv shift, int flags)
496 8984bd2e pbrook
{
497 8984bd2e pbrook
    if (flags) {
498 8984bd2e pbrook
        switch (shiftop) {
499 8984bd2e pbrook
        case 0: gen_helper_shl_cc(var, var, shift); break;
500 8984bd2e pbrook
        case 1: gen_helper_shr_cc(var, var, shift); break;
501 8984bd2e pbrook
        case 2: gen_helper_sar_cc(var, var, shift); break;
502 8984bd2e pbrook
        case 3: gen_helper_ror_cc(var, var, shift); break;
503 8984bd2e pbrook
        }
504 8984bd2e pbrook
    } else {
505 8984bd2e pbrook
        switch (shiftop) {
506 8984bd2e pbrook
        case 0: gen_helper_shl(var, var, shift); break;
507 8984bd2e pbrook
        case 1: gen_helper_shr(var, var, shift); break;
508 8984bd2e pbrook
        case 2: gen_helper_sar(var, var, shift); break;
509 f669df27 Aurelien Jarno
        case 3: tcg_gen_andi_i32(shift, shift, 0x1f);
510 f669df27 Aurelien Jarno
                tcg_gen_rotr_i32(var, var, shift); break;
511 8984bd2e pbrook
        }
512 8984bd2e pbrook
    }
513 8984bd2e pbrook
    dead_tmp(shift);
514 8984bd2e pbrook
}
515 8984bd2e pbrook
516 6ddbc6e4 pbrook
#define PAS_OP(pfx) \
517 6ddbc6e4 pbrook
    switch (op2) {  \
518 6ddbc6e4 pbrook
    case 0: gen_pas_helper(glue(pfx,add16)); break; \
519 6ddbc6e4 pbrook
    case 1: gen_pas_helper(glue(pfx,addsubx)); break; \
520 6ddbc6e4 pbrook
    case 2: gen_pas_helper(glue(pfx,subaddx)); break; \
521 6ddbc6e4 pbrook
    case 3: gen_pas_helper(glue(pfx,sub16)); break; \
522 6ddbc6e4 pbrook
    case 4: gen_pas_helper(glue(pfx,add8)); break; \
523 6ddbc6e4 pbrook
    case 7: gen_pas_helper(glue(pfx,sub8)); break; \
524 6ddbc6e4 pbrook
    }
525 d9ba4830 pbrook
static void gen_arm_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
526 6ddbc6e4 pbrook
{
527 a7812ae4 pbrook
    TCGv_ptr tmp;
528 6ddbc6e4 pbrook
529 6ddbc6e4 pbrook
    switch (op1) {
530 6ddbc6e4 pbrook
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
531 6ddbc6e4 pbrook
    case 1:
532 a7812ae4 pbrook
        tmp = tcg_temp_new_ptr();
533 6ddbc6e4 pbrook
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
534 6ddbc6e4 pbrook
        PAS_OP(s)
535 b75263d6 Juha Riihimรคki
        tcg_temp_free_ptr(tmp);
536 6ddbc6e4 pbrook
        break;
537 6ddbc6e4 pbrook
    case 5:
538 a7812ae4 pbrook
        tmp = tcg_temp_new_ptr();
539 6ddbc6e4 pbrook
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
540 6ddbc6e4 pbrook
        PAS_OP(u)
541 b75263d6 Juha Riihimรคki
        tcg_temp_free_ptr(tmp);
542 6ddbc6e4 pbrook
        break;
543 6ddbc6e4 pbrook
#undef gen_pas_helper
544 6ddbc6e4 pbrook
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b)
545 6ddbc6e4 pbrook
    case 2:
546 6ddbc6e4 pbrook
        PAS_OP(q);
547 6ddbc6e4 pbrook
        break;
548 6ddbc6e4 pbrook
    case 3:
549 6ddbc6e4 pbrook
        PAS_OP(sh);
550 6ddbc6e4 pbrook
        break;
551 6ddbc6e4 pbrook
    case 6:
552 6ddbc6e4 pbrook
        PAS_OP(uq);
553 6ddbc6e4 pbrook
        break;
554 6ddbc6e4 pbrook
    case 7:
555 6ddbc6e4 pbrook
        PAS_OP(uh);
556 6ddbc6e4 pbrook
        break;
557 6ddbc6e4 pbrook
#undef gen_pas_helper
558 6ddbc6e4 pbrook
    }
559 6ddbc6e4 pbrook
}
560 9ee6e8bb pbrook
#undef PAS_OP
561 9ee6e8bb pbrook
562 6ddbc6e4 pbrook
/* For unknown reasons Arm and Thumb-2 use arbitrarily different encodings.  */
563 6ddbc6e4 pbrook
#define PAS_OP(pfx) \
564 6ddbc6e4 pbrook
    switch (op2) {  \
565 6ddbc6e4 pbrook
    case 0: gen_pas_helper(glue(pfx,add8)); break; \
566 6ddbc6e4 pbrook
    case 1: gen_pas_helper(glue(pfx,add16)); break; \
567 6ddbc6e4 pbrook
    case 2: gen_pas_helper(glue(pfx,addsubx)); break; \
568 6ddbc6e4 pbrook
    case 4: gen_pas_helper(glue(pfx,sub8)); break; \
569 6ddbc6e4 pbrook
    case 5: gen_pas_helper(glue(pfx,sub16)); break; \
570 6ddbc6e4 pbrook
    case 6: gen_pas_helper(glue(pfx,subaddx)); break; \
571 6ddbc6e4 pbrook
    }
572 d9ba4830 pbrook
static void gen_thumb2_parallel_addsub(int op1, int op2, TCGv a, TCGv b)
573 6ddbc6e4 pbrook
{
574 a7812ae4 pbrook
    TCGv_ptr tmp;
575 6ddbc6e4 pbrook
576 6ddbc6e4 pbrook
    switch (op1) {
577 6ddbc6e4 pbrook
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b, tmp)
578 6ddbc6e4 pbrook
    case 0:
579 a7812ae4 pbrook
        tmp = tcg_temp_new_ptr();
580 6ddbc6e4 pbrook
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
581 6ddbc6e4 pbrook
        PAS_OP(s)
582 b75263d6 Juha Riihimรคki
        tcg_temp_free_ptr(tmp);
583 6ddbc6e4 pbrook
        break;
584 6ddbc6e4 pbrook
    case 4:
585 a7812ae4 pbrook
        tmp = tcg_temp_new_ptr();
586 6ddbc6e4 pbrook
        tcg_gen_addi_ptr(tmp, cpu_env, offsetof(CPUState, GE));
587 6ddbc6e4 pbrook
        PAS_OP(u)
588 b75263d6 Juha Riihimรคki
        tcg_temp_free_ptr(tmp);
589 6ddbc6e4 pbrook
        break;
590 6ddbc6e4 pbrook
#undef gen_pas_helper
591 6ddbc6e4 pbrook
#define gen_pas_helper(name) glue(gen_helper_,name)(a, a, b)
592 6ddbc6e4 pbrook
    case 1:
593 6ddbc6e4 pbrook
        PAS_OP(q);
594 6ddbc6e4 pbrook
        break;
595 6ddbc6e4 pbrook
    case 2:
596 6ddbc6e4 pbrook
        PAS_OP(sh);
597 6ddbc6e4 pbrook
        break;
598 6ddbc6e4 pbrook
    case 5:
599 6ddbc6e4 pbrook
        PAS_OP(uq);
600 6ddbc6e4 pbrook
        break;
601 6ddbc6e4 pbrook
    case 6:
602 6ddbc6e4 pbrook
        PAS_OP(uh);
603 6ddbc6e4 pbrook
        break;
604 6ddbc6e4 pbrook
#undef gen_pas_helper
605 6ddbc6e4 pbrook
    }
606 6ddbc6e4 pbrook
}
607 9ee6e8bb pbrook
#undef PAS_OP
608 9ee6e8bb pbrook
609 d9ba4830 pbrook
static void gen_test_cc(int cc, int label)
610 d9ba4830 pbrook
{
611 d9ba4830 pbrook
    TCGv tmp;
612 d9ba4830 pbrook
    TCGv tmp2;
613 d9ba4830 pbrook
    int inv;
614 d9ba4830 pbrook
615 d9ba4830 pbrook
    switch (cc) {
616 d9ba4830 pbrook
    case 0: /* eq: Z */
617 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
618 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
619 d9ba4830 pbrook
        break;
620 d9ba4830 pbrook
    case 1: /* ne: !Z */
621 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
622 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
623 d9ba4830 pbrook
        break;
624 d9ba4830 pbrook
    case 2: /* cs: C */
625 d9ba4830 pbrook
        tmp = load_cpu_field(CF);
626 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
627 d9ba4830 pbrook
        break;
628 d9ba4830 pbrook
    case 3: /* cc: !C */
629 d9ba4830 pbrook
        tmp = load_cpu_field(CF);
630 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
631 d9ba4830 pbrook
        break;
632 d9ba4830 pbrook
    case 4: /* mi: N */
633 6fbe23d5 pbrook
        tmp = load_cpu_field(NF);
634 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
635 d9ba4830 pbrook
        break;
636 d9ba4830 pbrook
    case 5: /* pl: !N */
637 6fbe23d5 pbrook
        tmp = load_cpu_field(NF);
638 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
639 d9ba4830 pbrook
        break;
640 d9ba4830 pbrook
    case 6: /* vs: V */
641 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
642 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
643 d9ba4830 pbrook
        break;
644 d9ba4830 pbrook
    case 7: /* vc: !V */
645 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
646 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
647 d9ba4830 pbrook
        break;
648 d9ba4830 pbrook
    case 8: /* hi: C && !Z */
649 d9ba4830 pbrook
        inv = gen_new_label();
650 d9ba4830 pbrook
        tmp = load_cpu_field(CF);
651 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, inv);
652 d9ba4830 pbrook
        dead_tmp(tmp);
653 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
654 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, label);
655 d9ba4830 pbrook
        gen_set_label(inv);
656 d9ba4830 pbrook
        break;
657 d9ba4830 pbrook
    case 9: /* ls: !C || Z */
658 d9ba4830 pbrook
        tmp = load_cpu_field(CF);
659 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
660 d9ba4830 pbrook
        dead_tmp(tmp);
661 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
662 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
663 d9ba4830 pbrook
        break;
664 d9ba4830 pbrook
    case 10: /* ge: N == V -> N ^ V == 0 */
665 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
666 6fbe23d5 pbrook
        tmp2 = load_cpu_field(NF);
667 d9ba4830 pbrook
        tcg_gen_xor_i32(tmp, tmp, tmp2);
668 d9ba4830 pbrook
        dead_tmp(tmp2);
669 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
670 d9ba4830 pbrook
        break;
671 d9ba4830 pbrook
    case 11: /* lt: N != V -> N ^ V != 0 */
672 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
673 6fbe23d5 pbrook
        tmp2 = load_cpu_field(NF);
674 d9ba4830 pbrook
        tcg_gen_xor_i32(tmp, tmp, tmp2);
675 d9ba4830 pbrook
        dead_tmp(tmp2);
676 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
677 d9ba4830 pbrook
        break;
678 d9ba4830 pbrook
    case 12: /* gt: !Z && N == V */
679 d9ba4830 pbrook
        inv = gen_new_label();
680 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
681 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, inv);
682 d9ba4830 pbrook
        dead_tmp(tmp);
683 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
684 6fbe23d5 pbrook
        tmp2 = load_cpu_field(NF);
685 d9ba4830 pbrook
        tcg_gen_xor_i32(tmp, tmp, tmp2);
686 d9ba4830 pbrook
        dead_tmp(tmp2);
687 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_GE, tmp, 0, label);
688 d9ba4830 pbrook
        gen_set_label(inv);
689 d9ba4830 pbrook
        break;
690 d9ba4830 pbrook
    case 13: /* le: Z || N != V */
691 6fbe23d5 pbrook
        tmp = load_cpu_field(ZF);
692 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, label);
693 d9ba4830 pbrook
        dead_tmp(tmp);
694 d9ba4830 pbrook
        tmp = load_cpu_field(VF);
695 6fbe23d5 pbrook
        tmp2 = load_cpu_field(NF);
696 d9ba4830 pbrook
        tcg_gen_xor_i32(tmp, tmp, tmp2);
697 d9ba4830 pbrook
        dead_tmp(tmp2);
698 cb63669a pbrook
        tcg_gen_brcondi_i32(TCG_COND_LT, tmp, 0, label);
699 d9ba4830 pbrook
        break;
700 d9ba4830 pbrook
    default:
701 d9ba4830 pbrook
        fprintf(stderr, "Bad condition code 0x%x\n", cc);
702 d9ba4830 pbrook
        abort();
703 d9ba4830 pbrook
    }
704 d9ba4830 pbrook
    dead_tmp(tmp);
705 d9ba4830 pbrook
}
706 2c0262af bellard
707 b1d8e52e blueswir1
static const uint8_t table_logic_cc[16] = {
708 2c0262af bellard
    1, /* and */
709 2c0262af bellard
    1, /* xor */
710 2c0262af bellard
    0, /* sub */
711 2c0262af bellard
    0, /* rsb */
712 2c0262af bellard
    0, /* add */
713 2c0262af bellard
    0, /* adc */
714 2c0262af bellard
    0, /* sbc */
715 2c0262af bellard
    0, /* rsc */
716 2c0262af bellard
    1, /* andl */
717 2c0262af bellard
    1, /* xorl */
718 2c0262af bellard
    0, /* cmp */
719 2c0262af bellard
    0, /* cmn */
720 2c0262af bellard
    1, /* orr */
721 2c0262af bellard
    1, /* mov */
722 2c0262af bellard
    1, /* bic */
723 2c0262af bellard
    1, /* mvn */
724 2c0262af bellard
};
725 3b46e624 ths
726 d9ba4830 pbrook
/* Set PC and Thumb state from an immediate address.  */
727 d9ba4830 pbrook
static inline void gen_bx_im(DisasContext *s, uint32_t addr)
728 99c475ab bellard
{
729 b26eefb6 pbrook
    TCGv tmp;
730 99c475ab bellard
731 b26eefb6 pbrook
    s->is_jmp = DISAS_UPDATE;
732 d9ba4830 pbrook
    if (s->thumb != (addr & 1)) {
733 155c3eac Filip Navara
        tmp = new_tmp();
734 d9ba4830 pbrook
        tcg_gen_movi_i32(tmp, addr & 1);
735 d9ba4830 pbrook
        tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUState, thumb));
736 155c3eac Filip Navara
        dead_tmp(tmp);
737 d9ba4830 pbrook
    }
738 155c3eac Filip Navara
    tcg_gen_movi_i32(cpu_R[15], addr & ~1);
739 d9ba4830 pbrook
}
740 d9ba4830 pbrook
741 d9ba4830 pbrook
/* Set PC and Thumb state from var.  var is marked as dead.  */
742 d9ba4830 pbrook
static inline void gen_bx(DisasContext *s, TCGv var)
743 d9ba4830 pbrook
{
744 d9ba4830 pbrook
    s->is_jmp = DISAS_UPDATE;
745 155c3eac Filip Navara
    tcg_gen_andi_i32(cpu_R[15], var, ~1);
746 155c3eac Filip Navara
    tcg_gen_andi_i32(var, var, 1);
747 155c3eac Filip Navara
    store_cpu_field(var, thumb);
748 d9ba4830 pbrook
}
749 d9ba4830 pbrook
750 21aeb343 Juha Riihimรคki
/* Variant of store_reg which uses branch&exchange logic when storing
751 21aeb343 Juha Riihimรคki
   to r15 in ARM architecture v7 and above. The source must be a temporary
752 21aeb343 Juha Riihimรคki
   and will be marked as dead. */
753 21aeb343 Juha Riihimรคki
static inline void store_reg_bx(CPUState *env, DisasContext *s,
754 21aeb343 Juha Riihimรคki
                                int reg, TCGv var)
755 21aeb343 Juha Riihimรคki
{
756 21aeb343 Juha Riihimรคki
    if (reg == 15 && ENABLE_ARCH_7) {
757 21aeb343 Juha Riihimรคki
        gen_bx(s, var);
758 21aeb343 Juha Riihimรคki
    } else {
759 21aeb343 Juha Riihimรคki
        store_reg(s, reg, var);
760 21aeb343 Juha Riihimรคki
    }
761 21aeb343 Juha Riihimรคki
}
762 21aeb343 Juha Riihimรคki
763 b0109805 pbrook
static inline TCGv gen_ld8s(TCGv addr, int index)
764 b0109805 pbrook
{
765 b0109805 pbrook
    TCGv tmp = new_tmp();
766 b0109805 pbrook
    tcg_gen_qemu_ld8s(tmp, addr, index);
767 b0109805 pbrook
    return tmp;
768 b0109805 pbrook
}
769 b0109805 pbrook
static inline TCGv gen_ld8u(TCGv addr, int index)
770 b0109805 pbrook
{
771 b0109805 pbrook
    TCGv tmp = new_tmp();
772 b0109805 pbrook
    tcg_gen_qemu_ld8u(tmp, addr, index);
773 b0109805 pbrook
    return tmp;
774 b0109805 pbrook
}
775 b0109805 pbrook
static inline TCGv gen_ld16s(TCGv addr, int index)
776 b0109805 pbrook
{
777 b0109805 pbrook
    TCGv tmp = new_tmp();
778 b0109805 pbrook
    tcg_gen_qemu_ld16s(tmp, addr, index);
779 b0109805 pbrook
    return tmp;
780 b0109805 pbrook
}
781 b0109805 pbrook
static inline TCGv gen_ld16u(TCGv addr, int index)
782 b0109805 pbrook
{
783 b0109805 pbrook
    TCGv tmp = new_tmp();
784 b0109805 pbrook
    tcg_gen_qemu_ld16u(tmp, addr, index);
785 b0109805 pbrook
    return tmp;
786 b0109805 pbrook
}
787 b0109805 pbrook
static inline TCGv gen_ld32(TCGv addr, int index)
788 b0109805 pbrook
{
789 b0109805 pbrook
    TCGv tmp = new_tmp();
790 b0109805 pbrook
    tcg_gen_qemu_ld32u(tmp, addr, index);
791 b0109805 pbrook
    return tmp;
792 b0109805 pbrook
}
793 84496233 Juha Riihimรคki
static inline TCGv_i64 gen_ld64(TCGv addr, int index)
794 84496233 Juha Riihimรคki
{
795 84496233 Juha Riihimรคki
    TCGv_i64 tmp = tcg_temp_new_i64();
796 84496233 Juha Riihimรคki
    tcg_gen_qemu_ld64(tmp, addr, index);
797 84496233 Juha Riihimรคki
    return tmp;
798 84496233 Juha Riihimรคki
}
799 b0109805 pbrook
static inline void gen_st8(TCGv val, TCGv addr, int index)
800 b0109805 pbrook
{
801 b0109805 pbrook
    tcg_gen_qemu_st8(val, addr, index);
802 b0109805 pbrook
    dead_tmp(val);
803 b0109805 pbrook
}
804 b0109805 pbrook
static inline void gen_st16(TCGv val, TCGv addr, int index)
805 b0109805 pbrook
{
806 b0109805 pbrook
    tcg_gen_qemu_st16(val, addr, index);
807 b0109805 pbrook
    dead_tmp(val);
808 b0109805 pbrook
}
809 b0109805 pbrook
static inline void gen_st32(TCGv val, TCGv addr, int index)
810 b0109805 pbrook
{
811 b0109805 pbrook
    tcg_gen_qemu_st32(val, addr, index);
812 b0109805 pbrook
    dead_tmp(val);
813 b0109805 pbrook
}
814 84496233 Juha Riihimรคki
static inline void gen_st64(TCGv_i64 val, TCGv addr, int index)
815 84496233 Juha Riihimรคki
{
816 84496233 Juha Riihimรคki
    tcg_gen_qemu_st64(val, addr, index);
817 84496233 Juha Riihimรคki
    tcg_temp_free_i64(val);
818 84496233 Juha Riihimรคki
}
819 b5ff1b31 bellard
820 5e3f878a pbrook
static inline void gen_set_pc_im(uint32_t val)
821 5e3f878a pbrook
{
822 155c3eac Filip Navara
    tcg_gen_movi_i32(cpu_R[15], val);
823 5e3f878a pbrook
}
824 5e3f878a pbrook
825 b5ff1b31 bellard
/* Force a TB lookup after an instruction that changes the CPU state.  */
826 b5ff1b31 bellard
static inline void gen_lookup_tb(DisasContext *s)
827 b5ff1b31 bellard
{
828 a6445c52 Filip Navara
    tcg_gen_movi_i32(cpu_R[15], s->pc & ~1);
829 b5ff1b31 bellard
    s->is_jmp = DISAS_UPDATE;
830 b5ff1b31 bellard
}
831 b5ff1b31 bellard
832 b0109805 pbrook
static inline void gen_add_data_offset(DisasContext *s, unsigned int insn,
833 b0109805 pbrook
                                       TCGv var)
834 2c0262af bellard
{
835 1e8d4eec bellard
    int val, rm, shift, shiftop;
836 b26eefb6 pbrook
    TCGv offset;
837 2c0262af bellard
838 2c0262af bellard
    if (!(insn & (1 << 25))) {
839 2c0262af bellard
        /* immediate */
840 2c0262af bellard
        val = insn & 0xfff;
841 2c0262af bellard
        if (!(insn & (1 << 23)))
842 2c0262af bellard
            val = -val;
843 537730b9 bellard
        if (val != 0)
844 b0109805 pbrook
            tcg_gen_addi_i32(var, var, val);
845 2c0262af bellard
    } else {
846 2c0262af bellard
        /* shift/register */
847 2c0262af bellard
        rm = (insn) & 0xf;
848 2c0262af bellard
        shift = (insn >> 7) & 0x1f;
849 1e8d4eec bellard
        shiftop = (insn >> 5) & 3;
850 b26eefb6 pbrook
        offset = load_reg(s, rm);
851 9a119ff6 pbrook
        gen_arm_shift_im(offset, shiftop, shift, 0);
852 2c0262af bellard
        if (!(insn & (1 << 23)))
853 b0109805 pbrook
            tcg_gen_sub_i32(var, var, offset);
854 2c0262af bellard
        else
855 b0109805 pbrook
            tcg_gen_add_i32(var, var, offset);
856 b26eefb6 pbrook
        dead_tmp(offset);
857 2c0262af bellard
    }
858 2c0262af bellard
}
859 2c0262af bellard
860 191f9a93 pbrook
static inline void gen_add_datah_offset(DisasContext *s, unsigned int insn,
861 b0109805 pbrook
                                        int extra, TCGv var)
862 2c0262af bellard
{
863 2c0262af bellard
    int val, rm;
864 b26eefb6 pbrook
    TCGv offset;
865 3b46e624 ths
866 2c0262af bellard
    if (insn & (1 << 22)) {
867 2c0262af bellard
        /* immediate */
868 2c0262af bellard
        val = (insn & 0xf) | ((insn >> 4) & 0xf0);
869 2c0262af bellard
        if (!(insn & (1 << 23)))
870 2c0262af bellard
            val = -val;
871 18acad92 pbrook
        val += extra;
872 537730b9 bellard
        if (val != 0)
873 b0109805 pbrook
            tcg_gen_addi_i32(var, var, val);
874 2c0262af bellard
    } else {
875 2c0262af bellard
        /* register */
876 191f9a93 pbrook
        if (extra)
877 b0109805 pbrook
            tcg_gen_addi_i32(var, var, extra);
878 2c0262af bellard
        rm = (insn) & 0xf;
879 b26eefb6 pbrook
        offset = load_reg(s, rm);
880 2c0262af bellard
        if (!(insn & (1 << 23)))
881 b0109805 pbrook
            tcg_gen_sub_i32(var, var, offset);
882 2c0262af bellard
        else
883 b0109805 pbrook
            tcg_gen_add_i32(var, var, offset);
884 b26eefb6 pbrook
        dead_tmp(offset);
885 2c0262af bellard
    }
886 2c0262af bellard
}
887 2c0262af bellard
888 4373f3ce pbrook
#define VFP_OP2(name)                                                 \
889 4373f3ce pbrook
static inline void gen_vfp_##name(int dp)                             \
890 4373f3ce pbrook
{                                                                     \
891 4373f3ce pbrook
    if (dp)                                                           \
892 4373f3ce pbrook
        gen_helper_vfp_##name##d(cpu_F0d, cpu_F0d, cpu_F1d, cpu_env); \
893 4373f3ce pbrook
    else                                                              \
894 4373f3ce pbrook
        gen_helper_vfp_##name##s(cpu_F0s, cpu_F0s, cpu_F1s, cpu_env); \
895 b7bcbe95 bellard
}
896 b7bcbe95 bellard
897 4373f3ce pbrook
VFP_OP2(add)
898 4373f3ce pbrook
VFP_OP2(sub)
899 4373f3ce pbrook
VFP_OP2(mul)
900 4373f3ce pbrook
VFP_OP2(div)
901 4373f3ce pbrook
902 4373f3ce pbrook
#undef VFP_OP2
903 4373f3ce pbrook
904 4373f3ce pbrook
static inline void gen_vfp_abs(int dp)
905 4373f3ce pbrook
{
906 4373f3ce pbrook
    if (dp)
907 4373f3ce pbrook
        gen_helper_vfp_absd(cpu_F0d, cpu_F0d);
908 4373f3ce pbrook
    else
909 4373f3ce pbrook
        gen_helper_vfp_abss(cpu_F0s, cpu_F0s);
910 4373f3ce pbrook
}
911 4373f3ce pbrook
912 4373f3ce pbrook
static inline void gen_vfp_neg(int dp)
913 4373f3ce pbrook
{
914 4373f3ce pbrook
    if (dp)
915 4373f3ce pbrook
        gen_helper_vfp_negd(cpu_F0d, cpu_F0d);
916 4373f3ce pbrook
    else
917 4373f3ce pbrook
        gen_helper_vfp_negs(cpu_F0s, cpu_F0s);
918 4373f3ce pbrook
}
919 4373f3ce pbrook
920 4373f3ce pbrook
static inline void gen_vfp_sqrt(int dp)
921 4373f3ce pbrook
{
922 4373f3ce pbrook
    if (dp)
923 4373f3ce pbrook
        gen_helper_vfp_sqrtd(cpu_F0d, cpu_F0d, cpu_env);
924 4373f3ce pbrook
    else
925 4373f3ce pbrook
        gen_helper_vfp_sqrts(cpu_F0s, cpu_F0s, cpu_env);
926 4373f3ce pbrook
}
927 4373f3ce pbrook
928 4373f3ce pbrook
static inline void gen_vfp_cmp(int dp)
929 4373f3ce pbrook
{
930 4373f3ce pbrook
    if (dp)
931 4373f3ce pbrook
        gen_helper_vfp_cmpd(cpu_F0d, cpu_F1d, cpu_env);
932 4373f3ce pbrook
    else
933 4373f3ce pbrook
        gen_helper_vfp_cmps(cpu_F0s, cpu_F1s, cpu_env);
934 4373f3ce pbrook
}
935 4373f3ce pbrook
936 4373f3ce pbrook
static inline void gen_vfp_cmpe(int dp)
937 4373f3ce pbrook
{
938 4373f3ce pbrook
    if (dp)
939 4373f3ce pbrook
        gen_helper_vfp_cmped(cpu_F0d, cpu_F1d, cpu_env);
940 4373f3ce pbrook
    else
941 4373f3ce pbrook
        gen_helper_vfp_cmpes(cpu_F0s, cpu_F1s, cpu_env);
942 4373f3ce pbrook
}
943 4373f3ce pbrook
944 4373f3ce pbrook
static inline void gen_vfp_F1_ld0(int dp)
945 4373f3ce pbrook
{
946 4373f3ce pbrook
    if (dp)
947 5b340b51 balrog
        tcg_gen_movi_i64(cpu_F1d, 0);
948 4373f3ce pbrook
    else
949 5b340b51 balrog
        tcg_gen_movi_i32(cpu_F1s, 0);
950 4373f3ce pbrook
}
951 4373f3ce pbrook
952 4373f3ce pbrook
static inline void gen_vfp_uito(int dp)
953 4373f3ce pbrook
{
954 4373f3ce pbrook
    if (dp)
955 4373f3ce pbrook
        gen_helper_vfp_uitod(cpu_F0d, cpu_F0s, cpu_env);
956 4373f3ce pbrook
    else
957 4373f3ce pbrook
        gen_helper_vfp_uitos(cpu_F0s, cpu_F0s, cpu_env);
958 4373f3ce pbrook
}
959 4373f3ce pbrook
960 4373f3ce pbrook
static inline void gen_vfp_sito(int dp)
961 4373f3ce pbrook
{
962 4373f3ce pbrook
    if (dp)
963 66230e0d balrog
        gen_helper_vfp_sitod(cpu_F0d, cpu_F0s, cpu_env);
964 4373f3ce pbrook
    else
965 66230e0d balrog
        gen_helper_vfp_sitos(cpu_F0s, cpu_F0s, cpu_env);
966 4373f3ce pbrook
}
967 4373f3ce pbrook
968 4373f3ce pbrook
static inline void gen_vfp_toui(int dp)
969 4373f3ce pbrook
{
970 4373f3ce pbrook
    if (dp)
971 4373f3ce pbrook
        gen_helper_vfp_touid(cpu_F0s, cpu_F0d, cpu_env);
972 4373f3ce pbrook
    else
973 4373f3ce pbrook
        gen_helper_vfp_touis(cpu_F0s, cpu_F0s, cpu_env);
974 4373f3ce pbrook
}
975 4373f3ce pbrook
976 4373f3ce pbrook
static inline void gen_vfp_touiz(int dp)
977 4373f3ce pbrook
{
978 4373f3ce pbrook
    if (dp)
979 4373f3ce pbrook
        gen_helper_vfp_touizd(cpu_F0s, cpu_F0d, cpu_env);
980 4373f3ce pbrook
    else
981 4373f3ce pbrook
        gen_helper_vfp_touizs(cpu_F0s, cpu_F0s, cpu_env);
982 4373f3ce pbrook
}
983 4373f3ce pbrook
984 4373f3ce pbrook
static inline void gen_vfp_tosi(int dp)
985 4373f3ce pbrook
{
986 4373f3ce pbrook
    if (dp)
987 4373f3ce pbrook
        gen_helper_vfp_tosid(cpu_F0s, cpu_F0d, cpu_env);
988 4373f3ce pbrook
    else
989 4373f3ce pbrook
        gen_helper_vfp_tosis(cpu_F0s, cpu_F0s, cpu_env);
990 4373f3ce pbrook
}
991 4373f3ce pbrook
992 4373f3ce pbrook
static inline void gen_vfp_tosiz(int dp)
993 9ee6e8bb pbrook
{
994 9ee6e8bb pbrook
    if (dp)
995 4373f3ce pbrook
        gen_helper_vfp_tosizd(cpu_F0s, cpu_F0d, cpu_env);
996 9ee6e8bb pbrook
    else
997 4373f3ce pbrook
        gen_helper_vfp_tosizs(cpu_F0s, cpu_F0s, cpu_env);
998 4373f3ce pbrook
}
999 4373f3ce pbrook
1000 4373f3ce pbrook
#define VFP_GEN_FIX(name) \
1001 4373f3ce pbrook
static inline void gen_vfp_##name(int dp, int shift) \
1002 4373f3ce pbrook
{ \
1003 b75263d6 Juha Riihimรคki
    TCGv tmp_shift = tcg_const_i32(shift); \
1004 4373f3ce pbrook
    if (dp) \
1005 b75263d6 Juha Riihimรคki
        gen_helper_vfp_##name##d(cpu_F0d, cpu_F0d, tmp_shift, cpu_env);\
1006 4373f3ce pbrook
    else \
1007 b75263d6 Juha Riihimรคki
        gen_helper_vfp_##name##s(cpu_F0s, cpu_F0s, tmp_shift, cpu_env);\
1008 b75263d6 Juha Riihimรคki
    tcg_temp_free_i32(tmp_shift); \
1009 9ee6e8bb pbrook
}
1010 4373f3ce pbrook
VFP_GEN_FIX(tosh)
1011 4373f3ce pbrook
VFP_GEN_FIX(tosl)
1012 4373f3ce pbrook
VFP_GEN_FIX(touh)
1013 4373f3ce pbrook
VFP_GEN_FIX(toul)
1014 4373f3ce pbrook
VFP_GEN_FIX(shto)
1015 4373f3ce pbrook
VFP_GEN_FIX(slto)
1016 4373f3ce pbrook
VFP_GEN_FIX(uhto)
1017 4373f3ce pbrook
VFP_GEN_FIX(ulto)
1018 4373f3ce pbrook
#undef VFP_GEN_FIX
1019 9ee6e8bb pbrook
1020 312eea9f Filip Navara
static inline void gen_vfp_ld(DisasContext *s, int dp, TCGv addr)
1021 b5ff1b31 bellard
{
1022 b5ff1b31 bellard
    if (dp)
1023 312eea9f Filip Navara
        tcg_gen_qemu_ld64(cpu_F0d, addr, IS_USER(s));
1024 b5ff1b31 bellard
    else
1025 312eea9f Filip Navara
        tcg_gen_qemu_ld32u(cpu_F0s, addr, IS_USER(s));
1026 b5ff1b31 bellard
}
1027 b5ff1b31 bellard
1028 312eea9f Filip Navara
static inline void gen_vfp_st(DisasContext *s, int dp, TCGv addr)
1029 b5ff1b31 bellard
{
1030 b5ff1b31 bellard
    if (dp)
1031 312eea9f Filip Navara
        tcg_gen_qemu_st64(cpu_F0d, addr, IS_USER(s));
1032 b5ff1b31 bellard
    else
1033 312eea9f Filip Navara
        tcg_gen_qemu_st32(cpu_F0s, addr, IS_USER(s));
1034 b5ff1b31 bellard
}
1035 b5ff1b31 bellard
1036 8e96005d bellard
static inline long
1037 8e96005d bellard
vfp_reg_offset (int dp, int reg)
1038 8e96005d bellard
{
1039 8e96005d bellard
    if (dp)
1040 8e96005d bellard
        return offsetof(CPUARMState, vfp.regs[reg]);
1041 8e96005d bellard
    else if (reg & 1) {
1042 8e96005d bellard
        return offsetof(CPUARMState, vfp.regs[reg >> 1])
1043 8e96005d bellard
          + offsetof(CPU_DoubleU, l.upper);
1044 8e96005d bellard
    } else {
1045 8e96005d bellard
        return offsetof(CPUARMState, vfp.regs[reg >> 1])
1046 8e96005d bellard
          + offsetof(CPU_DoubleU, l.lower);
1047 8e96005d bellard
    }
1048 8e96005d bellard
}
1049 9ee6e8bb pbrook
1050 9ee6e8bb pbrook
/* Return the offset of a 32-bit piece of a NEON register.
1051 9ee6e8bb pbrook
   zero is the least significant end of the register.  */
1052 9ee6e8bb pbrook
static inline long
1053 9ee6e8bb pbrook
neon_reg_offset (int reg, int n)
1054 9ee6e8bb pbrook
{
1055 9ee6e8bb pbrook
    int sreg;
1056 9ee6e8bb pbrook
    sreg = reg * 2 + n;
1057 9ee6e8bb pbrook
    return vfp_reg_offset(0, sreg);
1058 9ee6e8bb pbrook
}
1059 9ee6e8bb pbrook
1060 8f8e3aa4 pbrook
static TCGv neon_load_reg(int reg, int pass)
1061 8f8e3aa4 pbrook
{
1062 8f8e3aa4 pbrook
    TCGv tmp = new_tmp();
1063 8f8e3aa4 pbrook
    tcg_gen_ld_i32(tmp, cpu_env, neon_reg_offset(reg, pass));
1064 8f8e3aa4 pbrook
    return tmp;
1065 8f8e3aa4 pbrook
}
1066 8f8e3aa4 pbrook
1067 8f8e3aa4 pbrook
static void neon_store_reg(int reg, int pass, TCGv var)
1068 8f8e3aa4 pbrook
{
1069 8f8e3aa4 pbrook
    tcg_gen_st_i32(var, cpu_env, neon_reg_offset(reg, pass));
1070 8f8e3aa4 pbrook
    dead_tmp(var);
1071 8f8e3aa4 pbrook
}
1072 8f8e3aa4 pbrook
1073 a7812ae4 pbrook
static inline void neon_load_reg64(TCGv_i64 var, int reg)
1074 ad69471c pbrook
{
1075 ad69471c pbrook
    tcg_gen_ld_i64(var, cpu_env, vfp_reg_offset(1, reg));
1076 ad69471c pbrook
}
1077 ad69471c pbrook
1078 a7812ae4 pbrook
static inline void neon_store_reg64(TCGv_i64 var, int reg)
1079 ad69471c pbrook
{
1080 ad69471c pbrook
    tcg_gen_st_i64(var, cpu_env, vfp_reg_offset(1, reg));
1081 ad69471c pbrook
}
1082 ad69471c pbrook
1083 4373f3ce pbrook
#define tcg_gen_ld_f32 tcg_gen_ld_i32
1084 4373f3ce pbrook
#define tcg_gen_ld_f64 tcg_gen_ld_i64
1085 4373f3ce pbrook
#define tcg_gen_st_f32 tcg_gen_st_i32
1086 4373f3ce pbrook
#define tcg_gen_st_f64 tcg_gen_st_i64
1087 4373f3ce pbrook
1088 b7bcbe95 bellard
static inline void gen_mov_F0_vreg(int dp, int reg)
1089 b7bcbe95 bellard
{
1090 b7bcbe95 bellard
    if (dp)
1091 4373f3ce pbrook
        tcg_gen_ld_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
1092 b7bcbe95 bellard
    else
1093 4373f3ce pbrook
        tcg_gen_ld_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
1094 b7bcbe95 bellard
}
1095 b7bcbe95 bellard
1096 b7bcbe95 bellard
static inline void gen_mov_F1_vreg(int dp, int reg)
1097 b7bcbe95 bellard
{
1098 b7bcbe95 bellard
    if (dp)
1099 4373f3ce pbrook
        tcg_gen_ld_f64(cpu_F1d, cpu_env, vfp_reg_offset(dp, reg));
1100 b7bcbe95 bellard
    else
1101 4373f3ce pbrook
        tcg_gen_ld_f32(cpu_F1s, cpu_env, vfp_reg_offset(dp, reg));
1102 b7bcbe95 bellard
}
1103 b7bcbe95 bellard
1104 b7bcbe95 bellard
static inline void gen_mov_vreg_F0(int dp, int reg)
1105 b7bcbe95 bellard
{
1106 b7bcbe95 bellard
    if (dp)
1107 4373f3ce pbrook
        tcg_gen_st_f64(cpu_F0d, cpu_env, vfp_reg_offset(dp, reg));
1108 b7bcbe95 bellard
    else
1109 4373f3ce pbrook
        tcg_gen_st_f32(cpu_F0s, cpu_env, vfp_reg_offset(dp, reg));
1110 b7bcbe95 bellard
}
1111 b7bcbe95 bellard
1112 18c9b560 balrog
#define ARM_CP_RW_BIT        (1 << 20)
1113 18c9b560 balrog
1114 a7812ae4 pbrook
static inline void iwmmxt_load_reg(TCGv_i64 var, int reg)
1115 e677137d pbrook
{
1116 e677137d pbrook
    tcg_gen_ld_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
1117 e677137d pbrook
}
1118 e677137d pbrook
1119 a7812ae4 pbrook
static inline void iwmmxt_store_reg(TCGv_i64 var, int reg)
1120 e677137d pbrook
{
1121 e677137d pbrook
    tcg_gen_st_i64(var, cpu_env, offsetof(CPUState, iwmmxt.regs[reg]));
1122 e677137d pbrook
}
1123 e677137d pbrook
1124 da6b5335 Filip Navara
static inline TCGv iwmmxt_load_creg(int reg)
1125 e677137d pbrook
{
1126 da6b5335 Filip Navara
    TCGv var = new_tmp();
1127 da6b5335 Filip Navara
    tcg_gen_ld_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
1128 da6b5335 Filip Navara
    return var;
1129 e677137d pbrook
}
1130 e677137d pbrook
1131 da6b5335 Filip Navara
static inline void iwmmxt_store_creg(int reg, TCGv var)
1132 e677137d pbrook
{
1133 da6b5335 Filip Navara
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUState, iwmmxt.cregs[reg]));
1134 e677137d pbrook
}
1135 e677137d pbrook
1136 e677137d pbrook
static inline void gen_op_iwmmxt_movq_wRn_M0(int rn)
1137 e677137d pbrook
{
1138 e677137d pbrook
    iwmmxt_store_reg(cpu_M0, rn);
1139 e677137d pbrook
}
1140 e677137d pbrook
1141 e677137d pbrook
static inline void gen_op_iwmmxt_movq_M0_wRn(int rn)
1142 e677137d pbrook
{
1143 e677137d pbrook
    iwmmxt_load_reg(cpu_M0, rn);
1144 e677137d pbrook
}
1145 e677137d pbrook
1146 e677137d pbrook
static inline void gen_op_iwmmxt_orq_M0_wRn(int rn)
1147 e677137d pbrook
{
1148 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn);
1149 e677137d pbrook
    tcg_gen_or_i64(cpu_M0, cpu_M0, cpu_V1);
1150 e677137d pbrook
}
1151 e677137d pbrook
1152 e677137d pbrook
static inline void gen_op_iwmmxt_andq_M0_wRn(int rn)
1153 e677137d pbrook
{
1154 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn);
1155 e677137d pbrook
    tcg_gen_and_i64(cpu_M0, cpu_M0, cpu_V1);
1156 e677137d pbrook
}
1157 e677137d pbrook
1158 e677137d pbrook
static inline void gen_op_iwmmxt_xorq_M0_wRn(int rn)
1159 e677137d pbrook
{
1160 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn);
1161 e677137d pbrook
    tcg_gen_xor_i64(cpu_M0, cpu_M0, cpu_V1);
1162 e677137d pbrook
}
1163 e677137d pbrook
1164 e677137d pbrook
#define IWMMXT_OP(name) \
1165 e677137d pbrook
static inline void gen_op_iwmmxt_##name##_M0_wRn(int rn) \
1166 e677137d pbrook
{ \
1167 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn); \
1168 e677137d pbrook
    gen_helper_iwmmxt_##name(cpu_M0, cpu_M0, cpu_V1); \
1169 e677137d pbrook
}
1170 e677137d pbrook
1171 e677137d pbrook
#define IWMMXT_OP_ENV(name) \
1172 e677137d pbrook
static inline void gen_op_iwmmxt_##name##_M0_wRn(int rn) \
1173 e677137d pbrook
{ \
1174 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn); \
1175 e677137d pbrook
    gen_helper_iwmmxt_##name(cpu_M0, cpu_env, cpu_M0, cpu_V1); \
1176 e677137d pbrook
}
1177 e677137d pbrook
1178 e677137d pbrook
#define IWMMXT_OP_ENV_SIZE(name) \
1179 e677137d pbrook
IWMMXT_OP_ENV(name##b) \
1180 e677137d pbrook
IWMMXT_OP_ENV(name##w) \
1181 e677137d pbrook
IWMMXT_OP_ENV(name##l)
1182 e677137d pbrook
1183 e677137d pbrook
#define IWMMXT_OP_ENV1(name) \
1184 e677137d pbrook
static inline void gen_op_iwmmxt_##name##_M0(void) \
1185 e677137d pbrook
{ \
1186 e677137d pbrook
    gen_helper_iwmmxt_##name(cpu_M0, cpu_env, cpu_M0); \
1187 e677137d pbrook
}
1188 e677137d pbrook
1189 e677137d pbrook
IWMMXT_OP(maddsq)
1190 e677137d pbrook
IWMMXT_OP(madduq)
1191 e677137d pbrook
IWMMXT_OP(sadb)
1192 e677137d pbrook
IWMMXT_OP(sadw)
1193 e677137d pbrook
IWMMXT_OP(mulslw)
1194 e677137d pbrook
IWMMXT_OP(mulshw)
1195 e677137d pbrook
IWMMXT_OP(mululw)
1196 e677137d pbrook
IWMMXT_OP(muluhw)
1197 e677137d pbrook
IWMMXT_OP(macsw)
1198 e677137d pbrook
IWMMXT_OP(macuw)
1199 e677137d pbrook
1200 e677137d pbrook
IWMMXT_OP_ENV_SIZE(unpackl)
1201 e677137d pbrook
IWMMXT_OP_ENV_SIZE(unpackh)
1202 e677137d pbrook
1203 e677137d pbrook
IWMMXT_OP_ENV1(unpacklub)
1204 e677137d pbrook
IWMMXT_OP_ENV1(unpackluw)
1205 e677137d pbrook
IWMMXT_OP_ENV1(unpacklul)
1206 e677137d pbrook
IWMMXT_OP_ENV1(unpackhub)
1207 e677137d pbrook
IWMMXT_OP_ENV1(unpackhuw)
1208 e677137d pbrook
IWMMXT_OP_ENV1(unpackhul)
1209 e677137d pbrook
IWMMXT_OP_ENV1(unpacklsb)
1210 e677137d pbrook
IWMMXT_OP_ENV1(unpacklsw)
1211 e677137d pbrook
IWMMXT_OP_ENV1(unpacklsl)
1212 e677137d pbrook
IWMMXT_OP_ENV1(unpackhsb)
1213 e677137d pbrook
IWMMXT_OP_ENV1(unpackhsw)
1214 e677137d pbrook
IWMMXT_OP_ENV1(unpackhsl)
1215 e677137d pbrook
1216 e677137d pbrook
IWMMXT_OP_ENV_SIZE(cmpeq)
1217 e677137d pbrook
IWMMXT_OP_ENV_SIZE(cmpgtu)
1218 e677137d pbrook
IWMMXT_OP_ENV_SIZE(cmpgts)
1219 e677137d pbrook
1220 e677137d pbrook
IWMMXT_OP_ENV_SIZE(mins)
1221 e677137d pbrook
IWMMXT_OP_ENV_SIZE(minu)
1222 e677137d pbrook
IWMMXT_OP_ENV_SIZE(maxs)
1223 e677137d pbrook
IWMMXT_OP_ENV_SIZE(maxu)
1224 e677137d pbrook
1225 e677137d pbrook
IWMMXT_OP_ENV_SIZE(subn)
1226 e677137d pbrook
IWMMXT_OP_ENV_SIZE(addn)
1227 e677137d pbrook
IWMMXT_OP_ENV_SIZE(subu)
1228 e677137d pbrook
IWMMXT_OP_ENV_SIZE(addu)
1229 e677137d pbrook
IWMMXT_OP_ENV_SIZE(subs)
1230 e677137d pbrook
IWMMXT_OP_ENV_SIZE(adds)
1231 e677137d pbrook
1232 e677137d pbrook
IWMMXT_OP_ENV(avgb0)
1233 e677137d pbrook
IWMMXT_OP_ENV(avgb1)
1234 e677137d pbrook
IWMMXT_OP_ENV(avgw0)
1235 e677137d pbrook
IWMMXT_OP_ENV(avgw1)
1236 e677137d pbrook
1237 e677137d pbrook
IWMMXT_OP(msadb)
1238 e677137d pbrook
1239 e677137d pbrook
IWMMXT_OP_ENV(packuw)
1240 e677137d pbrook
IWMMXT_OP_ENV(packul)
1241 e677137d pbrook
IWMMXT_OP_ENV(packuq)
1242 e677137d pbrook
IWMMXT_OP_ENV(packsw)
1243 e677137d pbrook
IWMMXT_OP_ENV(packsl)
1244 e677137d pbrook
IWMMXT_OP_ENV(packsq)
1245 e677137d pbrook
1246 e677137d pbrook
static void gen_op_iwmmxt_set_mup(void)
1247 e677137d pbrook
{
1248 e677137d pbrook
    TCGv tmp;
1249 e677137d pbrook
    tmp = load_cpu_field(iwmmxt.cregs[ARM_IWMMXT_wCon]);
1250 e677137d pbrook
    tcg_gen_ori_i32(tmp, tmp, 2);
1251 e677137d pbrook
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCon]);
1252 e677137d pbrook
}
1253 e677137d pbrook
1254 e677137d pbrook
static void gen_op_iwmmxt_set_cup(void)
1255 e677137d pbrook
{
1256 e677137d pbrook
    TCGv tmp;
1257 e677137d pbrook
    tmp = load_cpu_field(iwmmxt.cregs[ARM_IWMMXT_wCon]);
1258 e677137d pbrook
    tcg_gen_ori_i32(tmp, tmp, 1);
1259 e677137d pbrook
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCon]);
1260 e677137d pbrook
}
1261 e677137d pbrook
1262 e677137d pbrook
static void gen_op_iwmmxt_setpsr_nz(void)
1263 e677137d pbrook
{
1264 e677137d pbrook
    TCGv tmp = new_tmp();
1265 e677137d pbrook
    gen_helper_iwmmxt_setpsr_nz(tmp, cpu_M0);
1266 e677137d pbrook
    store_cpu_field(tmp, iwmmxt.cregs[ARM_IWMMXT_wCASF]);
1267 e677137d pbrook
}
1268 e677137d pbrook
1269 e677137d pbrook
static inline void gen_op_iwmmxt_addl_M0_wRn(int rn)
1270 e677137d pbrook
{
1271 e677137d pbrook
    iwmmxt_load_reg(cpu_V1, rn);
1272 86831435 pbrook
    tcg_gen_ext32u_i64(cpu_V1, cpu_V1);
1273 e677137d pbrook
    tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
1274 e677137d pbrook
}
1275 e677137d pbrook
1276 da6b5335 Filip Navara
static inline int gen_iwmmxt_address(DisasContext *s, uint32_t insn, TCGv dest)
1277 18c9b560 balrog
{
1278 18c9b560 balrog
    int rd;
1279 18c9b560 balrog
    uint32_t offset;
1280 da6b5335 Filip Navara
    TCGv tmp;
1281 18c9b560 balrog
1282 18c9b560 balrog
    rd = (insn >> 16) & 0xf;
1283 da6b5335 Filip Navara
    tmp = load_reg(s, rd);
1284 18c9b560 balrog
1285 18c9b560 balrog
    offset = (insn & 0xff) << ((insn >> 7) & 2);
1286 18c9b560 balrog
    if (insn & (1 << 24)) {
1287 18c9b560 balrog
        /* Pre indexed */
1288 18c9b560 balrog
        if (insn & (1 << 23))
1289 da6b5335 Filip Navara
            tcg_gen_addi_i32(tmp, tmp, offset);
1290 18c9b560 balrog
        else
1291 da6b5335 Filip Navara
            tcg_gen_addi_i32(tmp, tmp, -offset);
1292 da6b5335 Filip Navara
        tcg_gen_mov_i32(dest, tmp);
1293 18c9b560 balrog
        if (insn & (1 << 21))
1294 da6b5335 Filip Navara
            store_reg(s, rd, tmp);
1295 da6b5335 Filip Navara
        else
1296 da6b5335 Filip Navara
            dead_tmp(tmp);
1297 18c9b560 balrog
    } else if (insn & (1 << 21)) {
1298 18c9b560 balrog
        /* Post indexed */
1299 da6b5335 Filip Navara
        tcg_gen_mov_i32(dest, tmp);
1300 18c9b560 balrog
        if (insn & (1 << 23))
1301 da6b5335 Filip Navara
            tcg_gen_addi_i32(tmp, tmp, offset);
1302 18c9b560 balrog
        else
1303 da6b5335 Filip Navara
            tcg_gen_addi_i32(tmp, tmp, -offset);
1304 da6b5335 Filip Navara
        store_reg(s, rd, tmp);
1305 18c9b560 balrog
    } else if (!(insn & (1 << 23)))
1306 18c9b560 balrog
        return 1;
1307 18c9b560 balrog
    return 0;
1308 18c9b560 balrog
}
1309 18c9b560 balrog
1310 da6b5335 Filip Navara
static inline int gen_iwmmxt_shift(uint32_t insn, uint32_t mask, TCGv dest)
1311 18c9b560 balrog
{
1312 18c9b560 balrog
    int rd = (insn >> 0) & 0xf;
1313 da6b5335 Filip Navara
    TCGv tmp;
1314 18c9b560 balrog
1315 da6b5335 Filip Navara
    if (insn & (1 << 8)) {
1316 da6b5335 Filip Navara
        if (rd < ARM_IWMMXT_wCGR0 || rd > ARM_IWMMXT_wCGR3) {
1317 18c9b560 balrog
            return 1;
1318 da6b5335 Filip Navara
        } else {
1319 da6b5335 Filip Navara
            tmp = iwmmxt_load_creg(rd);
1320 da6b5335 Filip Navara
        }
1321 da6b5335 Filip Navara
    } else {
1322 da6b5335 Filip Navara
        tmp = new_tmp();
1323 da6b5335 Filip Navara
        iwmmxt_load_reg(cpu_V0, rd);
1324 da6b5335 Filip Navara
        tcg_gen_trunc_i64_i32(tmp, cpu_V0);
1325 da6b5335 Filip Navara
    }
1326 da6b5335 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, mask);
1327 da6b5335 Filip Navara
    tcg_gen_mov_i32(dest, tmp);
1328 da6b5335 Filip Navara
    dead_tmp(tmp);
1329 18c9b560 balrog
    return 0;
1330 18c9b560 balrog
}
1331 18c9b560 balrog
1332 18c9b560 balrog
/* Disassemble an iwMMXt instruction.  Returns nonzero if an error occured
1333 18c9b560 balrog
   (ie. an undefined instruction).  */
1334 18c9b560 balrog
static int disas_iwmmxt_insn(CPUState *env, DisasContext *s, uint32_t insn)
1335 18c9b560 balrog
{
1336 18c9b560 balrog
    int rd, wrd;
1337 18c9b560 balrog
    int rdhi, rdlo, rd0, rd1, i;
1338 da6b5335 Filip Navara
    TCGv addr;
1339 da6b5335 Filip Navara
    TCGv tmp, tmp2, tmp3;
1340 18c9b560 balrog
1341 18c9b560 balrog
    if ((insn & 0x0e000e00) == 0x0c000000) {
1342 18c9b560 balrog
        if ((insn & 0x0fe00ff0) == 0x0c400000) {
1343 18c9b560 balrog
            wrd = insn & 0xf;
1344 18c9b560 balrog
            rdlo = (insn >> 12) & 0xf;
1345 18c9b560 balrog
            rdhi = (insn >> 16) & 0xf;
1346 18c9b560 balrog
            if (insn & ARM_CP_RW_BIT) {                        /* TMRRC */
1347 da6b5335 Filip Navara
                iwmmxt_load_reg(cpu_V0, wrd);
1348 da6b5335 Filip Navara
                tcg_gen_trunc_i64_i32(cpu_R[rdlo], cpu_V0);
1349 da6b5335 Filip Navara
                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
1350 da6b5335 Filip Navara
                tcg_gen_trunc_i64_i32(cpu_R[rdhi], cpu_V0);
1351 18c9b560 balrog
            } else {                                        /* TMCRR */
1352 da6b5335 Filip Navara
                tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
1353 da6b5335 Filip Navara
                iwmmxt_store_reg(cpu_V0, wrd);
1354 18c9b560 balrog
                gen_op_iwmmxt_set_mup();
1355 18c9b560 balrog
            }
1356 18c9b560 balrog
            return 0;
1357 18c9b560 balrog
        }
1358 18c9b560 balrog
1359 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1360 da6b5335 Filip Navara
        addr = new_tmp();
1361 da6b5335 Filip Navara
        if (gen_iwmmxt_address(s, insn, addr)) {
1362 da6b5335 Filip Navara
            dead_tmp(addr);
1363 18c9b560 balrog
            return 1;
1364 da6b5335 Filip Navara
        }
1365 18c9b560 balrog
        if (insn & ARM_CP_RW_BIT) {
1366 18c9b560 balrog
            if ((insn >> 28) == 0xf) {                        /* WLDRW wCx */
1367 da6b5335 Filip Navara
                tmp = new_tmp();
1368 da6b5335 Filip Navara
                tcg_gen_qemu_ld32u(tmp, addr, IS_USER(s));
1369 da6b5335 Filip Navara
                iwmmxt_store_creg(wrd, tmp);
1370 18c9b560 balrog
            } else {
1371 e677137d pbrook
                i = 1;
1372 e677137d pbrook
                if (insn & (1 << 8)) {
1373 e677137d pbrook
                    if (insn & (1 << 22)) {                /* WLDRD */
1374 da6b5335 Filip Navara
                        tcg_gen_qemu_ld64(cpu_M0, addr, IS_USER(s));
1375 e677137d pbrook
                        i = 0;
1376 e677137d pbrook
                    } else {                                /* WLDRW wRd */
1377 da6b5335 Filip Navara
                        tmp = gen_ld32(addr, IS_USER(s));
1378 e677137d pbrook
                    }
1379 e677137d pbrook
                } else {
1380 e677137d pbrook
                    if (insn & (1 << 22)) {                /* WLDRH */
1381 da6b5335 Filip Navara
                        tmp = gen_ld16u(addr, IS_USER(s));
1382 e677137d pbrook
                    } else {                                /* WLDRB */
1383 da6b5335 Filip Navara
                        tmp = gen_ld8u(addr, IS_USER(s));
1384 e677137d pbrook
                    }
1385 e677137d pbrook
                }
1386 e677137d pbrook
                if (i) {
1387 e677137d pbrook
                    tcg_gen_extu_i32_i64(cpu_M0, tmp);
1388 e677137d pbrook
                    dead_tmp(tmp);
1389 e677137d pbrook
                }
1390 18c9b560 balrog
                gen_op_iwmmxt_movq_wRn_M0(wrd);
1391 18c9b560 balrog
            }
1392 18c9b560 balrog
        } else {
1393 18c9b560 balrog
            if ((insn >> 28) == 0xf) {                        /* WSTRW wCx */
1394 da6b5335 Filip Navara
                tmp = iwmmxt_load_creg(wrd);
1395 da6b5335 Filip Navara
                gen_st32(tmp, addr, IS_USER(s));
1396 18c9b560 balrog
            } else {
1397 18c9b560 balrog
                gen_op_iwmmxt_movq_M0_wRn(wrd);
1398 e677137d pbrook
                tmp = new_tmp();
1399 e677137d pbrook
                if (insn & (1 << 8)) {
1400 e677137d pbrook
                    if (insn & (1 << 22)) {                /* WSTRD */
1401 e677137d pbrook
                        dead_tmp(tmp);
1402 da6b5335 Filip Navara
                        tcg_gen_qemu_st64(cpu_M0, addr, IS_USER(s));
1403 e677137d pbrook
                    } else {                                /* WSTRW wRd */
1404 e677137d pbrook
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1405 da6b5335 Filip Navara
                        gen_st32(tmp, addr, IS_USER(s));
1406 e677137d pbrook
                    }
1407 e677137d pbrook
                } else {
1408 e677137d pbrook
                    if (insn & (1 << 22)) {                /* WSTRH */
1409 e677137d pbrook
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1410 da6b5335 Filip Navara
                        gen_st16(tmp, addr, IS_USER(s));
1411 e677137d pbrook
                    } else {                                /* WSTRB */
1412 e677137d pbrook
                        tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1413 da6b5335 Filip Navara
                        gen_st8(tmp, addr, IS_USER(s));
1414 e677137d pbrook
                    }
1415 e677137d pbrook
                }
1416 18c9b560 balrog
            }
1417 18c9b560 balrog
        }
1418 18c9b560 balrog
        return 0;
1419 18c9b560 balrog
    }
1420 18c9b560 balrog
1421 18c9b560 balrog
    if ((insn & 0x0f000000) != 0x0e000000)
1422 18c9b560 balrog
        return 1;
1423 18c9b560 balrog
1424 18c9b560 balrog
    switch (((insn >> 12) & 0xf00) | ((insn >> 4) & 0xff)) {
1425 18c9b560 balrog
    case 0x000:                                                /* WOR */
1426 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1427 18c9b560 balrog
        rd0 = (insn >> 0) & 0xf;
1428 18c9b560 balrog
        rd1 = (insn >> 16) & 0xf;
1429 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1430 18c9b560 balrog
        gen_op_iwmmxt_orq_M0_wRn(rd1);
1431 18c9b560 balrog
        gen_op_iwmmxt_setpsr_nz();
1432 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1433 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1434 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1435 18c9b560 balrog
        break;
1436 18c9b560 balrog
    case 0x011:                                                /* TMCR */
1437 18c9b560 balrog
        if (insn & 0xf)
1438 18c9b560 balrog
            return 1;
1439 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1440 18c9b560 balrog
        wrd = (insn >> 16) & 0xf;
1441 18c9b560 balrog
        switch (wrd) {
1442 18c9b560 balrog
        case ARM_IWMMXT_wCID:
1443 18c9b560 balrog
        case ARM_IWMMXT_wCASF:
1444 18c9b560 balrog
            break;
1445 18c9b560 balrog
        case ARM_IWMMXT_wCon:
1446 18c9b560 balrog
            gen_op_iwmmxt_set_cup();
1447 18c9b560 balrog
            /* Fall through.  */
1448 18c9b560 balrog
        case ARM_IWMMXT_wCSSF:
1449 da6b5335 Filip Navara
            tmp = iwmmxt_load_creg(wrd);
1450 da6b5335 Filip Navara
            tmp2 = load_reg(s, rd);
1451 f669df27 Aurelien Jarno
            tcg_gen_andc_i32(tmp, tmp, tmp2);
1452 da6b5335 Filip Navara
            dead_tmp(tmp2);
1453 da6b5335 Filip Navara
            iwmmxt_store_creg(wrd, tmp);
1454 18c9b560 balrog
            break;
1455 18c9b560 balrog
        case ARM_IWMMXT_wCGR0:
1456 18c9b560 balrog
        case ARM_IWMMXT_wCGR1:
1457 18c9b560 balrog
        case ARM_IWMMXT_wCGR2:
1458 18c9b560 balrog
        case ARM_IWMMXT_wCGR3:
1459 18c9b560 balrog
            gen_op_iwmmxt_set_cup();
1460 da6b5335 Filip Navara
            tmp = load_reg(s, rd);
1461 da6b5335 Filip Navara
            iwmmxt_store_creg(wrd, tmp);
1462 18c9b560 balrog
            break;
1463 18c9b560 balrog
        default:
1464 18c9b560 balrog
            return 1;
1465 18c9b560 balrog
        }
1466 18c9b560 balrog
        break;
1467 18c9b560 balrog
    case 0x100:                                                /* WXOR */
1468 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1469 18c9b560 balrog
        rd0 = (insn >> 0) & 0xf;
1470 18c9b560 balrog
        rd1 = (insn >> 16) & 0xf;
1471 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1472 18c9b560 balrog
        gen_op_iwmmxt_xorq_M0_wRn(rd1);
1473 18c9b560 balrog
        gen_op_iwmmxt_setpsr_nz();
1474 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1475 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1476 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1477 18c9b560 balrog
        break;
1478 18c9b560 balrog
    case 0x111:                                                /* TMRC */
1479 18c9b560 balrog
        if (insn & 0xf)
1480 18c9b560 balrog
            return 1;
1481 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1482 18c9b560 balrog
        wrd = (insn >> 16) & 0xf;
1483 da6b5335 Filip Navara
        tmp = iwmmxt_load_creg(wrd);
1484 da6b5335 Filip Navara
        store_reg(s, rd, tmp);
1485 18c9b560 balrog
        break;
1486 18c9b560 balrog
    case 0x300:                                                /* WANDN */
1487 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1488 18c9b560 balrog
        rd0 = (insn >> 0) & 0xf;
1489 18c9b560 balrog
        rd1 = (insn >> 16) & 0xf;
1490 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1491 e677137d pbrook
        tcg_gen_neg_i64(cpu_M0, cpu_M0);
1492 18c9b560 balrog
        gen_op_iwmmxt_andq_M0_wRn(rd1);
1493 18c9b560 balrog
        gen_op_iwmmxt_setpsr_nz();
1494 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1495 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1496 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1497 18c9b560 balrog
        break;
1498 18c9b560 balrog
    case 0x200:                                                /* WAND */
1499 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1500 18c9b560 balrog
        rd0 = (insn >> 0) & 0xf;
1501 18c9b560 balrog
        rd1 = (insn >> 16) & 0xf;
1502 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1503 18c9b560 balrog
        gen_op_iwmmxt_andq_M0_wRn(rd1);
1504 18c9b560 balrog
        gen_op_iwmmxt_setpsr_nz();
1505 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1506 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1507 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1508 18c9b560 balrog
        break;
1509 18c9b560 balrog
    case 0x810: case 0xa10:                                /* WMADD */
1510 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1511 18c9b560 balrog
        rd0 = (insn >> 0) & 0xf;
1512 18c9b560 balrog
        rd1 = (insn >> 16) & 0xf;
1513 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1514 18c9b560 balrog
        if (insn & (1 << 21))
1515 18c9b560 balrog
            gen_op_iwmmxt_maddsq_M0_wRn(rd1);
1516 18c9b560 balrog
        else
1517 18c9b560 balrog
            gen_op_iwmmxt_madduq_M0_wRn(rd1);
1518 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1519 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1520 18c9b560 balrog
        break;
1521 18c9b560 balrog
    case 0x10e: case 0x50e: case 0x90e: case 0xd0e:        /* WUNPCKIL */
1522 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1523 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1524 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1525 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1526 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1527 18c9b560 balrog
        case 0:
1528 18c9b560 balrog
            gen_op_iwmmxt_unpacklb_M0_wRn(rd1);
1529 18c9b560 balrog
            break;
1530 18c9b560 balrog
        case 1:
1531 18c9b560 balrog
            gen_op_iwmmxt_unpacklw_M0_wRn(rd1);
1532 18c9b560 balrog
            break;
1533 18c9b560 balrog
        case 2:
1534 18c9b560 balrog
            gen_op_iwmmxt_unpackll_M0_wRn(rd1);
1535 18c9b560 balrog
            break;
1536 18c9b560 balrog
        case 3:
1537 18c9b560 balrog
            return 1;
1538 18c9b560 balrog
        }
1539 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1540 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1541 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1542 18c9b560 balrog
        break;
1543 18c9b560 balrog
    case 0x10c: case 0x50c: case 0x90c: case 0xd0c:        /* WUNPCKIH */
1544 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1545 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1546 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1547 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1548 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1549 18c9b560 balrog
        case 0:
1550 18c9b560 balrog
            gen_op_iwmmxt_unpackhb_M0_wRn(rd1);
1551 18c9b560 balrog
            break;
1552 18c9b560 balrog
        case 1:
1553 18c9b560 balrog
            gen_op_iwmmxt_unpackhw_M0_wRn(rd1);
1554 18c9b560 balrog
            break;
1555 18c9b560 balrog
        case 2:
1556 18c9b560 balrog
            gen_op_iwmmxt_unpackhl_M0_wRn(rd1);
1557 18c9b560 balrog
            break;
1558 18c9b560 balrog
        case 3:
1559 18c9b560 balrog
            return 1;
1560 18c9b560 balrog
        }
1561 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1562 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1563 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1564 18c9b560 balrog
        break;
1565 18c9b560 balrog
    case 0x012: case 0x112: case 0x412: case 0x512:        /* WSAD */
1566 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1567 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1568 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1569 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1570 18c9b560 balrog
        if (insn & (1 << 22))
1571 18c9b560 balrog
            gen_op_iwmmxt_sadw_M0_wRn(rd1);
1572 18c9b560 balrog
        else
1573 18c9b560 balrog
            gen_op_iwmmxt_sadb_M0_wRn(rd1);
1574 18c9b560 balrog
        if (!(insn & (1 << 20)))
1575 18c9b560 balrog
            gen_op_iwmmxt_addl_M0_wRn(wrd);
1576 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1577 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1578 18c9b560 balrog
        break;
1579 18c9b560 balrog
    case 0x010: case 0x110: case 0x210: case 0x310:        /* WMUL */
1580 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1581 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1582 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1583 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1584 e677137d pbrook
        if (insn & (1 << 21)) {
1585 e677137d pbrook
            if (insn & (1 << 20))
1586 e677137d pbrook
                gen_op_iwmmxt_mulshw_M0_wRn(rd1);
1587 e677137d pbrook
            else
1588 e677137d pbrook
                gen_op_iwmmxt_mulslw_M0_wRn(rd1);
1589 e677137d pbrook
        } else {
1590 e677137d pbrook
            if (insn & (1 << 20))
1591 e677137d pbrook
                gen_op_iwmmxt_muluhw_M0_wRn(rd1);
1592 e677137d pbrook
            else
1593 e677137d pbrook
                gen_op_iwmmxt_mululw_M0_wRn(rd1);
1594 e677137d pbrook
        }
1595 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1596 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1597 18c9b560 balrog
        break;
1598 18c9b560 balrog
    case 0x410: case 0x510: case 0x610: case 0x710:        /* WMAC */
1599 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1600 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1601 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1602 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1603 18c9b560 balrog
        if (insn & (1 << 21))
1604 18c9b560 balrog
            gen_op_iwmmxt_macsw_M0_wRn(rd1);
1605 18c9b560 balrog
        else
1606 18c9b560 balrog
            gen_op_iwmmxt_macuw_M0_wRn(rd1);
1607 18c9b560 balrog
        if (!(insn & (1 << 20))) {
1608 e677137d pbrook
            iwmmxt_load_reg(cpu_V1, wrd);
1609 e677137d pbrook
            tcg_gen_add_i64(cpu_M0, cpu_M0, cpu_V1);
1610 18c9b560 balrog
        }
1611 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1612 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1613 18c9b560 balrog
        break;
1614 18c9b560 balrog
    case 0x006: case 0x406: case 0x806: case 0xc06:        /* WCMPEQ */
1615 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1616 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1617 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1618 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1619 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1620 18c9b560 balrog
        case 0:
1621 18c9b560 balrog
            gen_op_iwmmxt_cmpeqb_M0_wRn(rd1);
1622 18c9b560 balrog
            break;
1623 18c9b560 balrog
        case 1:
1624 18c9b560 balrog
            gen_op_iwmmxt_cmpeqw_M0_wRn(rd1);
1625 18c9b560 balrog
            break;
1626 18c9b560 balrog
        case 2:
1627 18c9b560 balrog
            gen_op_iwmmxt_cmpeql_M0_wRn(rd1);
1628 18c9b560 balrog
            break;
1629 18c9b560 balrog
        case 3:
1630 18c9b560 balrog
            return 1;
1631 18c9b560 balrog
        }
1632 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1633 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1634 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1635 18c9b560 balrog
        break;
1636 18c9b560 balrog
    case 0x800: case 0x900: case 0xc00: case 0xd00:        /* WAVG2 */
1637 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1638 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1639 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1640 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1641 e677137d pbrook
        if (insn & (1 << 22)) {
1642 e677137d pbrook
            if (insn & (1 << 20))
1643 e677137d pbrook
                gen_op_iwmmxt_avgw1_M0_wRn(rd1);
1644 e677137d pbrook
            else
1645 e677137d pbrook
                gen_op_iwmmxt_avgw0_M0_wRn(rd1);
1646 e677137d pbrook
        } else {
1647 e677137d pbrook
            if (insn & (1 << 20))
1648 e677137d pbrook
                gen_op_iwmmxt_avgb1_M0_wRn(rd1);
1649 e677137d pbrook
            else
1650 e677137d pbrook
                gen_op_iwmmxt_avgb0_M0_wRn(rd1);
1651 e677137d pbrook
        }
1652 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1653 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1654 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1655 18c9b560 balrog
        break;
1656 18c9b560 balrog
    case 0x802: case 0x902: case 0xa02: case 0xb02:        /* WALIGNR */
1657 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1658 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1659 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1660 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1661 da6b5335 Filip Navara
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCGR0 + ((insn >> 20) & 3));
1662 da6b5335 Filip Navara
        tcg_gen_andi_i32(tmp, tmp, 7);
1663 da6b5335 Filip Navara
        iwmmxt_load_reg(cpu_V1, rd1);
1664 da6b5335 Filip Navara
        gen_helper_iwmmxt_align(cpu_M0, cpu_M0, cpu_V1, tmp);
1665 da6b5335 Filip Navara
        dead_tmp(tmp);
1666 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1667 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1668 18c9b560 balrog
        break;
1669 18c9b560 balrog
    case 0x601: case 0x605: case 0x609: case 0x60d:        /* TINSR */
1670 da6b5335 Filip Navara
        if (((insn >> 6) & 3) == 3)
1671 da6b5335 Filip Navara
            return 1;
1672 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1673 18c9b560 balrog
        wrd = (insn >> 16) & 0xf;
1674 da6b5335 Filip Navara
        tmp = load_reg(s, rd);
1675 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(wrd);
1676 18c9b560 balrog
        switch ((insn >> 6) & 3) {
1677 18c9b560 balrog
        case 0:
1678 da6b5335 Filip Navara
            tmp2 = tcg_const_i32(0xff);
1679 da6b5335 Filip Navara
            tmp3 = tcg_const_i32((insn & 7) << 3);
1680 18c9b560 balrog
            break;
1681 18c9b560 balrog
        case 1:
1682 da6b5335 Filip Navara
            tmp2 = tcg_const_i32(0xffff);
1683 da6b5335 Filip Navara
            tmp3 = tcg_const_i32((insn & 3) << 4);
1684 18c9b560 balrog
            break;
1685 18c9b560 balrog
        case 2:
1686 da6b5335 Filip Navara
            tmp2 = tcg_const_i32(0xffffffff);
1687 da6b5335 Filip Navara
            tmp3 = tcg_const_i32((insn & 1) << 5);
1688 18c9b560 balrog
            break;
1689 da6b5335 Filip Navara
        default:
1690 da6b5335 Filip Navara
            TCGV_UNUSED(tmp2);
1691 da6b5335 Filip Navara
            TCGV_UNUSED(tmp3);
1692 18c9b560 balrog
        }
1693 da6b5335 Filip Navara
        gen_helper_iwmmxt_insr(cpu_M0, cpu_M0, tmp, tmp2, tmp3);
1694 da6b5335 Filip Navara
        tcg_temp_free(tmp3);
1695 da6b5335 Filip Navara
        tcg_temp_free(tmp2);
1696 da6b5335 Filip Navara
        dead_tmp(tmp);
1697 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1698 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1699 18c9b560 balrog
        break;
1700 18c9b560 balrog
    case 0x107: case 0x507: case 0x907: case 0xd07:        /* TEXTRM */
1701 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1702 18c9b560 balrog
        wrd = (insn >> 16) & 0xf;
1703 da6b5335 Filip Navara
        if (rd == 15 || ((insn >> 22) & 3) == 3)
1704 18c9b560 balrog
            return 1;
1705 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(wrd);
1706 da6b5335 Filip Navara
        tmp = new_tmp();
1707 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1708 18c9b560 balrog
        case 0:
1709 da6b5335 Filip Navara
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 7) << 3);
1710 da6b5335 Filip Navara
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1711 da6b5335 Filip Navara
            if (insn & 8) {
1712 da6b5335 Filip Navara
                tcg_gen_ext8s_i32(tmp, tmp);
1713 da6b5335 Filip Navara
            } else {
1714 da6b5335 Filip Navara
                tcg_gen_andi_i32(tmp, tmp, 0xff);
1715 18c9b560 balrog
            }
1716 18c9b560 balrog
            break;
1717 18c9b560 balrog
        case 1:
1718 da6b5335 Filip Navara
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 3) << 4);
1719 da6b5335 Filip Navara
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1720 da6b5335 Filip Navara
            if (insn & 8) {
1721 da6b5335 Filip Navara
                tcg_gen_ext16s_i32(tmp, tmp);
1722 da6b5335 Filip Navara
            } else {
1723 da6b5335 Filip Navara
                tcg_gen_andi_i32(tmp, tmp, 0xffff);
1724 18c9b560 balrog
            }
1725 18c9b560 balrog
            break;
1726 18c9b560 balrog
        case 2:
1727 da6b5335 Filip Navara
            tcg_gen_shri_i64(cpu_M0, cpu_M0, (insn & 1) << 5);
1728 da6b5335 Filip Navara
            tcg_gen_trunc_i64_i32(tmp, cpu_M0);
1729 18c9b560 balrog
            break;
1730 18c9b560 balrog
        }
1731 da6b5335 Filip Navara
        store_reg(s, rd, tmp);
1732 18c9b560 balrog
        break;
1733 18c9b560 balrog
    case 0x117: case 0x517: case 0x917: case 0xd17:        /* TEXTRC */
1734 da6b5335 Filip Navara
        if ((insn & 0x000ff008) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1735 18c9b560 balrog
            return 1;
1736 da6b5335 Filip Navara
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
1737 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1738 18c9b560 balrog
        case 0:
1739 da6b5335 Filip Navara
            tcg_gen_shri_i32(tmp, tmp, ((insn & 7) << 2) + 0);
1740 18c9b560 balrog
            break;
1741 18c9b560 balrog
        case 1:
1742 da6b5335 Filip Navara
            tcg_gen_shri_i32(tmp, tmp, ((insn & 3) << 3) + 4);
1743 18c9b560 balrog
            break;
1744 18c9b560 balrog
        case 2:
1745 da6b5335 Filip Navara
            tcg_gen_shri_i32(tmp, tmp, ((insn & 1) << 4) + 12);
1746 18c9b560 balrog
            break;
1747 18c9b560 balrog
        }
1748 da6b5335 Filip Navara
        tcg_gen_shli_i32(tmp, tmp, 28);
1749 da6b5335 Filip Navara
        gen_set_nzcv(tmp);
1750 da6b5335 Filip Navara
        dead_tmp(tmp);
1751 18c9b560 balrog
        break;
1752 18c9b560 balrog
    case 0x401: case 0x405: case 0x409: case 0x40d:        /* TBCST */
1753 da6b5335 Filip Navara
        if (((insn >> 6) & 3) == 3)
1754 da6b5335 Filip Navara
            return 1;
1755 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1756 18c9b560 balrog
        wrd = (insn >> 16) & 0xf;
1757 da6b5335 Filip Navara
        tmp = load_reg(s, rd);
1758 18c9b560 balrog
        switch ((insn >> 6) & 3) {
1759 18c9b560 balrog
        case 0:
1760 da6b5335 Filip Navara
            gen_helper_iwmmxt_bcstb(cpu_M0, tmp);
1761 18c9b560 balrog
            break;
1762 18c9b560 balrog
        case 1:
1763 da6b5335 Filip Navara
            gen_helper_iwmmxt_bcstw(cpu_M0, tmp);
1764 18c9b560 balrog
            break;
1765 18c9b560 balrog
        case 2:
1766 da6b5335 Filip Navara
            gen_helper_iwmmxt_bcstl(cpu_M0, tmp);
1767 18c9b560 balrog
            break;
1768 18c9b560 balrog
        }
1769 da6b5335 Filip Navara
        dead_tmp(tmp);
1770 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1771 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1772 18c9b560 balrog
        break;
1773 18c9b560 balrog
    case 0x113: case 0x513: case 0x913: case 0xd13:        /* TANDC */
1774 da6b5335 Filip Navara
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1775 18c9b560 balrog
            return 1;
1776 da6b5335 Filip Navara
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
1777 da6b5335 Filip Navara
        tmp2 = new_tmp();
1778 da6b5335 Filip Navara
        tcg_gen_mov_i32(tmp2, tmp);
1779 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1780 18c9b560 balrog
        case 0:
1781 18c9b560 balrog
            for (i = 0; i < 7; i ++) {
1782 da6b5335 Filip Navara
                tcg_gen_shli_i32(tmp2, tmp2, 4);
1783 da6b5335 Filip Navara
                tcg_gen_and_i32(tmp, tmp, tmp2);
1784 18c9b560 balrog
            }
1785 18c9b560 balrog
            break;
1786 18c9b560 balrog
        case 1:
1787 18c9b560 balrog
            for (i = 0; i < 3; i ++) {
1788 da6b5335 Filip Navara
                tcg_gen_shli_i32(tmp2, tmp2, 8);
1789 da6b5335 Filip Navara
                tcg_gen_and_i32(tmp, tmp, tmp2);
1790 18c9b560 balrog
            }
1791 18c9b560 balrog
            break;
1792 18c9b560 balrog
        case 2:
1793 da6b5335 Filip Navara
            tcg_gen_shli_i32(tmp2, tmp2, 16);
1794 da6b5335 Filip Navara
            tcg_gen_and_i32(tmp, tmp, tmp2);
1795 18c9b560 balrog
            break;
1796 18c9b560 balrog
        }
1797 da6b5335 Filip Navara
        gen_set_nzcv(tmp);
1798 da6b5335 Filip Navara
        dead_tmp(tmp2);
1799 da6b5335 Filip Navara
        dead_tmp(tmp);
1800 18c9b560 balrog
        break;
1801 18c9b560 balrog
    case 0x01c: case 0x41c: case 0x81c: case 0xc1c:        /* WACC */
1802 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1803 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1804 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1805 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1806 18c9b560 balrog
        case 0:
1807 e677137d pbrook
            gen_helper_iwmmxt_addcb(cpu_M0, cpu_M0);
1808 18c9b560 balrog
            break;
1809 18c9b560 balrog
        case 1:
1810 e677137d pbrook
            gen_helper_iwmmxt_addcw(cpu_M0, cpu_M0);
1811 18c9b560 balrog
            break;
1812 18c9b560 balrog
        case 2:
1813 e677137d pbrook
            gen_helper_iwmmxt_addcl(cpu_M0, cpu_M0);
1814 18c9b560 balrog
            break;
1815 18c9b560 balrog
        case 3:
1816 18c9b560 balrog
            return 1;
1817 18c9b560 balrog
        }
1818 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1819 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1820 18c9b560 balrog
        break;
1821 18c9b560 balrog
    case 0x115: case 0x515: case 0x915: case 0xd15:        /* TORC */
1822 da6b5335 Filip Navara
        if ((insn & 0x000ff00f) != 0x0003f000 || ((insn >> 22) & 3) == 3)
1823 18c9b560 balrog
            return 1;
1824 da6b5335 Filip Navara
        tmp = iwmmxt_load_creg(ARM_IWMMXT_wCASF);
1825 da6b5335 Filip Navara
        tmp2 = new_tmp();
1826 da6b5335 Filip Navara
        tcg_gen_mov_i32(tmp2, tmp);
1827 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1828 18c9b560 balrog
        case 0:
1829 18c9b560 balrog
            for (i = 0; i < 7; i ++) {
1830 da6b5335 Filip Navara
                tcg_gen_shli_i32(tmp2, tmp2, 4);
1831 da6b5335 Filip Navara
                tcg_gen_or_i32(tmp, tmp, tmp2);
1832 18c9b560 balrog
            }
1833 18c9b560 balrog
            break;
1834 18c9b560 balrog
        case 1:
1835 18c9b560 balrog
            for (i = 0; i < 3; i ++) {
1836 da6b5335 Filip Navara
                tcg_gen_shli_i32(tmp2, tmp2, 8);
1837 da6b5335 Filip Navara
                tcg_gen_or_i32(tmp, tmp, tmp2);
1838 18c9b560 balrog
            }
1839 18c9b560 balrog
            break;
1840 18c9b560 balrog
        case 2:
1841 da6b5335 Filip Navara
            tcg_gen_shli_i32(tmp2, tmp2, 16);
1842 da6b5335 Filip Navara
            tcg_gen_or_i32(tmp, tmp, tmp2);
1843 18c9b560 balrog
            break;
1844 18c9b560 balrog
        }
1845 da6b5335 Filip Navara
        gen_set_nzcv(tmp);
1846 da6b5335 Filip Navara
        dead_tmp(tmp2);
1847 da6b5335 Filip Navara
        dead_tmp(tmp);
1848 18c9b560 balrog
        break;
1849 18c9b560 balrog
    case 0x103: case 0x503: case 0x903: case 0xd03:        /* TMOVMSK */
1850 18c9b560 balrog
        rd = (insn >> 12) & 0xf;
1851 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1852 da6b5335 Filip Navara
        if ((insn & 0xf) != 0 || ((insn >> 22) & 3) == 3)
1853 18c9b560 balrog
            return 1;
1854 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1855 da6b5335 Filip Navara
        tmp = new_tmp();
1856 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1857 18c9b560 balrog
        case 0:
1858 da6b5335 Filip Navara
            gen_helper_iwmmxt_msbb(tmp, cpu_M0);
1859 18c9b560 balrog
            break;
1860 18c9b560 balrog
        case 1:
1861 da6b5335 Filip Navara
            gen_helper_iwmmxt_msbw(tmp, cpu_M0);
1862 18c9b560 balrog
            break;
1863 18c9b560 balrog
        case 2:
1864 da6b5335 Filip Navara
            gen_helper_iwmmxt_msbl(tmp, cpu_M0);
1865 18c9b560 balrog
            break;
1866 18c9b560 balrog
        }
1867 da6b5335 Filip Navara
        store_reg(s, rd, tmp);
1868 18c9b560 balrog
        break;
1869 18c9b560 balrog
    case 0x106: case 0x306: case 0x506: case 0x706:        /* WCMPGT */
1870 18c9b560 balrog
    case 0x906: case 0xb06: case 0xd06: case 0xf06:
1871 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1872 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1873 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
1874 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1875 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1876 18c9b560 balrog
        case 0:
1877 18c9b560 balrog
            if (insn & (1 << 21))
1878 18c9b560 balrog
                gen_op_iwmmxt_cmpgtsb_M0_wRn(rd1);
1879 18c9b560 balrog
            else
1880 18c9b560 balrog
                gen_op_iwmmxt_cmpgtub_M0_wRn(rd1);
1881 18c9b560 balrog
            break;
1882 18c9b560 balrog
        case 1:
1883 18c9b560 balrog
            if (insn & (1 << 21))
1884 18c9b560 balrog
                gen_op_iwmmxt_cmpgtsw_M0_wRn(rd1);
1885 18c9b560 balrog
            else
1886 18c9b560 balrog
                gen_op_iwmmxt_cmpgtuw_M0_wRn(rd1);
1887 18c9b560 balrog
            break;
1888 18c9b560 balrog
        case 2:
1889 18c9b560 balrog
            if (insn & (1 << 21))
1890 18c9b560 balrog
                gen_op_iwmmxt_cmpgtsl_M0_wRn(rd1);
1891 18c9b560 balrog
            else
1892 18c9b560 balrog
                gen_op_iwmmxt_cmpgtul_M0_wRn(rd1);
1893 18c9b560 balrog
            break;
1894 18c9b560 balrog
        case 3:
1895 18c9b560 balrog
            return 1;
1896 18c9b560 balrog
        }
1897 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1898 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1899 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1900 18c9b560 balrog
        break;
1901 18c9b560 balrog
    case 0x00e: case 0x20e: case 0x40e: case 0x60e:        /* WUNPCKEL */
1902 18c9b560 balrog
    case 0x80e: case 0xa0e: case 0xc0e: case 0xe0e:
1903 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1904 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1905 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1906 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1907 18c9b560 balrog
        case 0:
1908 18c9b560 balrog
            if (insn & (1 << 21))
1909 18c9b560 balrog
                gen_op_iwmmxt_unpacklsb_M0();
1910 18c9b560 balrog
            else
1911 18c9b560 balrog
                gen_op_iwmmxt_unpacklub_M0();
1912 18c9b560 balrog
            break;
1913 18c9b560 balrog
        case 1:
1914 18c9b560 balrog
            if (insn & (1 << 21))
1915 18c9b560 balrog
                gen_op_iwmmxt_unpacklsw_M0();
1916 18c9b560 balrog
            else
1917 18c9b560 balrog
                gen_op_iwmmxt_unpackluw_M0();
1918 18c9b560 balrog
            break;
1919 18c9b560 balrog
        case 2:
1920 18c9b560 balrog
            if (insn & (1 << 21))
1921 18c9b560 balrog
                gen_op_iwmmxt_unpacklsl_M0();
1922 18c9b560 balrog
            else
1923 18c9b560 balrog
                gen_op_iwmmxt_unpacklul_M0();
1924 18c9b560 balrog
            break;
1925 18c9b560 balrog
        case 3:
1926 18c9b560 balrog
            return 1;
1927 18c9b560 balrog
        }
1928 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1929 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1930 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1931 18c9b560 balrog
        break;
1932 18c9b560 balrog
    case 0x00c: case 0x20c: case 0x40c: case 0x60c:        /* WUNPCKEH */
1933 18c9b560 balrog
    case 0x80c: case 0xa0c: case 0xc0c: case 0xe0c:
1934 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1935 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1936 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1937 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1938 18c9b560 balrog
        case 0:
1939 18c9b560 balrog
            if (insn & (1 << 21))
1940 18c9b560 balrog
                gen_op_iwmmxt_unpackhsb_M0();
1941 18c9b560 balrog
            else
1942 18c9b560 balrog
                gen_op_iwmmxt_unpackhub_M0();
1943 18c9b560 balrog
            break;
1944 18c9b560 balrog
        case 1:
1945 18c9b560 balrog
            if (insn & (1 << 21))
1946 18c9b560 balrog
                gen_op_iwmmxt_unpackhsw_M0();
1947 18c9b560 balrog
            else
1948 18c9b560 balrog
                gen_op_iwmmxt_unpackhuw_M0();
1949 18c9b560 balrog
            break;
1950 18c9b560 balrog
        case 2:
1951 18c9b560 balrog
            if (insn & (1 << 21))
1952 18c9b560 balrog
                gen_op_iwmmxt_unpackhsl_M0();
1953 18c9b560 balrog
            else
1954 18c9b560 balrog
                gen_op_iwmmxt_unpackhul_M0();
1955 18c9b560 balrog
            break;
1956 18c9b560 balrog
        case 3:
1957 18c9b560 balrog
            return 1;
1958 18c9b560 balrog
        }
1959 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1960 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1961 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1962 18c9b560 balrog
        break;
1963 18c9b560 balrog
    case 0x204: case 0x604: case 0xa04: case 0xe04:        /* WSRL */
1964 18c9b560 balrog
    case 0x214: case 0x614: case 0xa14: case 0xe14:
1965 da6b5335 Filip Navara
        if (((insn >> 22) & 3) == 0)
1966 da6b5335 Filip Navara
            return 1;
1967 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1968 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1969 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1970 da6b5335 Filip Navara
        tmp = new_tmp();
1971 da6b5335 Filip Navara
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
1972 da6b5335 Filip Navara
            dead_tmp(tmp);
1973 18c9b560 balrog
            return 1;
1974 da6b5335 Filip Navara
        }
1975 18c9b560 balrog
        switch ((insn >> 22) & 3) {
1976 18c9b560 balrog
        case 1:
1977 da6b5335 Filip Navara
            gen_helper_iwmmxt_srlw(cpu_M0, cpu_env, cpu_M0, tmp);
1978 18c9b560 balrog
            break;
1979 18c9b560 balrog
        case 2:
1980 da6b5335 Filip Navara
            gen_helper_iwmmxt_srll(cpu_M0, cpu_env, cpu_M0, tmp);
1981 18c9b560 balrog
            break;
1982 18c9b560 balrog
        case 3:
1983 da6b5335 Filip Navara
            gen_helper_iwmmxt_srlq(cpu_M0, cpu_env, cpu_M0, tmp);
1984 18c9b560 balrog
            break;
1985 18c9b560 balrog
        }
1986 da6b5335 Filip Navara
        dead_tmp(tmp);
1987 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
1988 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
1989 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
1990 18c9b560 balrog
        break;
1991 18c9b560 balrog
    case 0x004: case 0x404: case 0x804: case 0xc04:        /* WSRA */
1992 18c9b560 balrog
    case 0x014: case 0x414: case 0x814: case 0xc14:
1993 da6b5335 Filip Navara
        if (((insn >> 22) & 3) == 0)
1994 da6b5335 Filip Navara
            return 1;
1995 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
1996 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
1997 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
1998 da6b5335 Filip Navara
        tmp = new_tmp();
1999 da6b5335 Filip Navara
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
2000 da6b5335 Filip Navara
            dead_tmp(tmp);
2001 18c9b560 balrog
            return 1;
2002 da6b5335 Filip Navara
        }
2003 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2004 18c9b560 balrog
        case 1:
2005 da6b5335 Filip Navara
            gen_helper_iwmmxt_sraw(cpu_M0, cpu_env, cpu_M0, tmp);
2006 18c9b560 balrog
            break;
2007 18c9b560 balrog
        case 2:
2008 da6b5335 Filip Navara
            gen_helper_iwmmxt_sral(cpu_M0, cpu_env, cpu_M0, tmp);
2009 18c9b560 balrog
            break;
2010 18c9b560 balrog
        case 3:
2011 da6b5335 Filip Navara
            gen_helper_iwmmxt_sraq(cpu_M0, cpu_env, cpu_M0, tmp);
2012 18c9b560 balrog
            break;
2013 18c9b560 balrog
        }
2014 da6b5335 Filip Navara
        dead_tmp(tmp);
2015 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2016 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2017 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2018 18c9b560 balrog
        break;
2019 18c9b560 balrog
    case 0x104: case 0x504: case 0x904: case 0xd04:        /* WSLL */
2020 18c9b560 balrog
    case 0x114: case 0x514: case 0x914: case 0xd14:
2021 da6b5335 Filip Navara
        if (((insn >> 22) & 3) == 0)
2022 da6b5335 Filip Navara
            return 1;
2023 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2024 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2025 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2026 da6b5335 Filip Navara
        tmp = new_tmp();
2027 da6b5335 Filip Navara
        if (gen_iwmmxt_shift(insn, 0xff, tmp)) {
2028 da6b5335 Filip Navara
            dead_tmp(tmp);
2029 18c9b560 balrog
            return 1;
2030 da6b5335 Filip Navara
        }
2031 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2032 18c9b560 balrog
        case 1:
2033 da6b5335 Filip Navara
            gen_helper_iwmmxt_sllw(cpu_M0, cpu_env, cpu_M0, tmp);
2034 18c9b560 balrog
            break;
2035 18c9b560 balrog
        case 2:
2036 da6b5335 Filip Navara
            gen_helper_iwmmxt_slll(cpu_M0, cpu_env, cpu_M0, tmp);
2037 18c9b560 balrog
            break;
2038 18c9b560 balrog
        case 3:
2039 da6b5335 Filip Navara
            gen_helper_iwmmxt_sllq(cpu_M0, cpu_env, cpu_M0, tmp);
2040 18c9b560 balrog
            break;
2041 18c9b560 balrog
        }
2042 da6b5335 Filip Navara
        dead_tmp(tmp);
2043 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2044 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2045 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2046 18c9b560 balrog
        break;
2047 18c9b560 balrog
    case 0x304: case 0x704: case 0xb04: case 0xf04:        /* WROR */
2048 18c9b560 balrog
    case 0x314: case 0x714: case 0xb14: case 0xf14:
2049 da6b5335 Filip Navara
        if (((insn >> 22) & 3) == 0)
2050 da6b5335 Filip Navara
            return 1;
2051 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2052 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2053 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2054 da6b5335 Filip Navara
        tmp = new_tmp();
2055 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2056 18c9b560 balrog
        case 1:
2057 da6b5335 Filip Navara
            if (gen_iwmmxt_shift(insn, 0xf, tmp)) {
2058 da6b5335 Filip Navara
                dead_tmp(tmp);
2059 18c9b560 balrog
                return 1;
2060 da6b5335 Filip Navara
            }
2061 da6b5335 Filip Navara
            gen_helper_iwmmxt_rorw(cpu_M0, cpu_env, cpu_M0, tmp);
2062 18c9b560 balrog
            break;
2063 18c9b560 balrog
        case 2:
2064 da6b5335 Filip Navara
            if (gen_iwmmxt_shift(insn, 0x1f, tmp)) {
2065 da6b5335 Filip Navara
                dead_tmp(tmp);
2066 18c9b560 balrog
                return 1;
2067 da6b5335 Filip Navara
            }
2068 da6b5335 Filip Navara
            gen_helper_iwmmxt_rorl(cpu_M0, cpu_env, cpu_M0, tmp);
2069 18c9b560 balrog
            break;
2070 18c9b560 balrog
        case 3:
2071 da6b5335 Filip Navara
            if (gen_iwmmxt_shift(insn, 0x3f, tmp)) {
2072 da6b5335 Filip Navara
                dead_tmp(tmp);
2073 18c9b560 balrog
                return 1;
2074 da6b5335 Filip Navara
            }
2075 da6b5335 Filip Navara
            gen_helper_iwmmxt_rorq(cpu_M0, cpu_env, cpu_M0, tmp);
2076 18c9b560 balrog
            break;
2077 18c9b560 balrog
        }
2078 da6b5335 Filip Navara
        dead_tmp(tmp);
2079 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2080 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2081 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2082 18c9b560 balrog
        break;
2083 18c9b560 balrog
    case 0x116: case 0x316: case 0x516: case 0x716:        /* WMIN */
2084 18c9b560 balrog
    case 0x916: case 0xb16: case 0xd16: case 0xf16:
2085 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2086 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2087 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2088 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2089 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2090 18c9b560 balrog
        case 0:
2091 18c9b560 balrog
            if (insn & (1 << 21))
2092 18c9b560 balrog
                gen_op_iwmmxt_minsb_M0_wRn(rd1);
2093 18c9b560 balrog
            else
2094 18c9b560 balrog
                gen_op_iwmmxt_minub_M0_wRn(rd1);
2095 18c9b560 balrog
            break;
2096 18c9b560 balrog
        case 1:
2097 18c9b560 balrog
            if (insn & (1 << 21))
2098 18c9b560 balrog
                gen_op_iwmmxt_minsw_M0_wRn(rd1);
2099 18c9b560 balrog
            else
2100 18c9b560 balrog
                gen_op_iwmmxt_minuw_M0_wRn(rd1);
2101 18c9b560 balrog
            break;
2102 18c9b560 balrog
        case 2:
2103 18c9b560 balrog
            if (insn & (1 << 21))
2104 18c9b560 balrog
                gen_op_iwmmxt_minsl_M0_wRn(rd1);
2105 18c9b560 balrog
            else
2106 18c9b560 balrog
                gen_op_iwmmxt_minul_M0_wRn(rd1);
2107 18c9b560 balrog
            break;
2108 18c9b560 balrog
        case 3:
2109 18c9b560 balrog
            return 1;
2110 18c9b560 balrog
        }
2111 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2112 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2113 18c9b560 balrog
        break;
2114 18c9b560 balrog
    case 0x016: case 0x216: case 0x416: case 0x616:        /* WMAX */
2115 18c9b560 balrog
    case 0x816: case 0xa16: case 0xc16: case 0xe16:
2116 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2117 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2118 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2119 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2120 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2121 18c9b560 balrog
        case 0:
2122 18c9b560 balrog
            if (insn & (1 << 21))
2123 18c9b560 balrog
                gen_op_iwmmxt_maxsb_M0_wRn(rd1);
2124 18c9b560 balrog
            else
2125 18c9b560 balrog
                gen_op_iwmmxt_maxub_M0_wRn(rd1);
2126 18c9b560 balrog
            break;
2127 18c9b560 balrog
        case 1:
2128 18c9b560 balrog
            if (insn & (1 << 21))
2129 18c9b560 balrog
                gen_op_iwmmxt_maxsw_M0_wRn(rd1);
2130 18c9b560 balrog
            else
2131 18c9b560 balrog
                gen_op_iwmmxt_maxuw_M0_wRn(rd1);
2132 18c9b560 balrog
            break;
2133 18c9b560 balrog
        case 2:
2134 18c9b560 balrog
            if (insn & (1 << 21))
2135 18c9b560 balrog
                gen_op_iwmmxt_maxsl_M0_wRn(rd1);
2136 18c9b560 balrog
            else
2137 18c9b560 balrog
                gen_op_iwmmxt_maxul_M0_wRn(rd1);
2138 18c9b560 balrog
            break;
2139 18c9b560 balrog
        case 3:
2140 18c9b560 balrog
            return 1;
2141 18c9b560 balrog
        }
2142 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2143 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2144 18c9b560 balrog
        break;
2145 18c9b560 balrog
    case 0x002: case 0x102: case 0x202: case 0x302:        /* WALIGNI */
2146 18c9b560 balrog
    case 0x402: case 0x502: case 0x602: case 0x702:
2147 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2148 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2149 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2150 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2151 da6b5335 Filip Navara
        tmp = tcg_const_i32((insn >> 20) & 3);
2152 da6b5335 Filip Navara
        iwmmxt_load_reg(cpu_V1, rd1);
2153 da6b5335 Filip Navara
        gen_helper_iwmmxt_align(cpu_M0, cpu_M0, cpu_V1, tmp);
2154 da6b5335 Filip Navara
        tcg_temp_free(tmp);
2155 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2156 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2157 18c9b560 balrog
        break;
2158 18c9b560 balrog
    case 0x01a: case 0x11a: case 0x21a: case 0x31a:        /* WSUB */
2159 18c9b560 balrog
    case 0x41a: case 0x51a: case 0x61a: case 0x71a:
2160 18c9b560 balrog
    case 0x81a: case 0x91a: case 0xa1a: case 0xb1a:
2161 18c9b560 balrog
    case 0xc1a: case 0xd1a: case 0xe1a: case 0xf1a:
2162 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2163 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2164 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2165 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2166 18c9b560 balrog
        switch ((insn >> 20) & 0xf) {
2167 18c9b560 balrog
        case 0x0:
2168 18c9b560 balrog
            gen_op_iwmmxt_subnb_M0_wRn(rd1);
2169 18c9b560 balrog
            break;
2170 18c9b560 balrog
        case 0x1:
2171 18c9b560 balrog
            gen_op_iwmmxt_subub_M0_wRn(rd1);
2172 18c9b560 balrog
            break;
2173 18c9b560 balrog
        case 0x3:
2174 18c9b560 balrog
            gen_op_iwmmxt_subsb_M0_wRn(rd1);
2175 18c9b560 balrog
            break;
2176 18c9b560 balrog
        case 0x4:
2177 18c9b560 balrog
            gen_op_iwmmxt_subnw_M0_wRn(rd1);
2178 18c9b560 balrog
            break;
2179 18c9b560 balrog
        case 0x5:
2180 18c9b560 balrog
            gen_op_iwmmxt_subuw_M0_wRn(rd1);
2181 18c9b560 balrog
            break;
2182 18c9b560 balrog
        case 0x7:
2183 18c9b560 balrog
            gen_op_iwmmxt_subsw_M0_wRn(rd1);
2184 18c9b560 balrog
            break;
2185 18c9b560 balrog
        case 0x8:
2186 18c9b560 balrog
            gen_op_iwmmxt_subnl_M0_wRn(rd1);
2187 18c9b560 balrog
            break;
2188 18c9b560 balrog
        case 0x9:
2189 18c9b560 balrog
            gen_op_iwmmxt_subul_M0_wRn(rd1);
2190 18c9b560 balrog
            break;
2191 18c9b560 balrog
        case 0xb:
2192 18c9b560 balrog
            gen_op_iwmmxt_subsl_M0_wRn(rd1);
2193 18c9b560 balrog
            break;
2194 18c9b560 balrog
        default:
2195 18c9b560 balrog
            return 1;
2196 18c9b560 balrog
        }
2197 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2198 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2199 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2200 18c9b560 balrog
        break;
2201 18c9b560 balrog
    case 0x01e: case 0x11e: case 0x21e: case 0x31e:        /* WSHUFH */
2202 18c9b560 balrog
    case 0x41e: case 0x51e: case 0x61e: case 0x71e:
2203 18c9b560 balrog
    case 0x81e: case 0x91e: case 0xa1e: case 0xb1e:
2204 18c9b560 balrog
    case 0xc1e: case 0xd1e: case 0xe1e: case 0xf1e:
2205 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2206 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2207 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2208 da6b5335 Filip Navara
        tmp = tcg_const_i32(((insn >> 16) & 0xf0) | (insn & 0x0f));
2209 da6b5335 Filip Navara
        gen_helper_iwmmxt_shufh(cpu_M0, cpu_env, cpu_M0, tmp);
2210 da6b5335 Filip Navara
        tcg_temp_free(tmp);
2211 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2212 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2213 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2214 18c9b560 balrog
        break;
2215 18c9b560 balrog
    case 0x018: case 0x118: case 0x218: case 0x318:        /* WADD */
2216 18c9b560 balrog
    case 0x418: case 0x518: case 0x618: case 0x718:
2217 18c9b560 balrog
    case 0x818: case 0x918: case 0xa18: case 0xb18:
2218 18c9b560 balrog
    case 0xc18: case 0xd18: case 0xe18: case 0xf18:
2219 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2220 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2221 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2222 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2223 18c9b560 balrog
        switch ((insn >> 20) & 0xf) {
2224 18c9b560 balrog
        case 0x0:
2225 18c9b560 balrog
            gen_op_iwmmxt_addnb_M0_wRn(rd1);
2226 18c9b560 balrog
            break;
2227 18c9b560 balrog
        case 0x1:
2228 18c9b560 balrog
            gen_op_iwmmxt_addub_M0_wRn(rd1);
2229 18c9b560 balrog
            break;
2230 18c9b560 balrog
        case 0x3:
2231 18c9b560 balrog
            gen_op_iwmmxt_addsb_M0_wRn(rd1);
2232 18c9b560 balrog
            break;
2233 18c9b560 balrog
        case 0x4:
2234 18c9b560 balrog
            gen_op_iwmmxt_addnw_M0_wRn(rd1);
2235 18c9b560 balrog
            break;
2236 18c9b560 balrog
        case 0x5:
2237 18c9b560 balrog
            gen_op_iwmmxt_adduw_M0_wRn(rd1);
2238 18c9b560 balrog
            break;
2239 18c9b560 balrog
        case 0x7:
2240 18c9b560 balrog
            gen_op_iwmmxt_addsw_M0_wRn(rd1);
2241 18c9b560 balrog
            break;
2242 18c9b560 balrog
        case 0x8:
2243 18c9b560 balrog
            gen_op_iwmmxt_addnl_M0_wRn(rd1);
2244 18c9b560 balrog
            break;
2245 18c9b560 balrog
        case 0x9:
2246 18c9b560 balrog
            gen_op_iwmmxt_addul_M0_wRn(rd1);
2247 18c9b560 balrog
            break;
2248 18c9b560 balrog
        case 0xb:
2249 18c9b560 balrog
            gen_op_iwmmxt_addsl_M0_wRn(rd1);
2250 18c9b560 balrog
            break;
2251 18c9b560 balrog
        default:
2252 18c9b560 balrog
            return 1;
2253 18c9b560 balrog
        }
2254 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2255 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2256 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2257 18c9b560 balrog
        break;
2258 18c9b560 balrog
    case 0x008: case 0x108: case 0x208: case 0x308:        /* WPACK */
2259 18c9b560 balrog
    case 0x408: case 0x508: case 0x608: case 0x708:
2260 18c9b560 balrog
    case 0x808: case 0x908: case 0xa08: case 0xb08:
2261 18c9b560 balrog
    case 0xc08: case 0xd08: case 0xe08: case 0xf08:
2262 da6b5335 Filip Navara
        if (!(insn & (1 << 20)) || ((insn >> 22) & 3) == 0)
2263 da6b5335 Filip Navara
            return 1;
2264 18c9b560 balrog
        wrd = (insn >> 12) & 0xf;
2265 18c9b560 balrog
        rd0 = (insn >> 16) & 0xf;
2266 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2267 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(rd0);
2268 18c9b560 balrog
        switch ((insn >> 22) & 3) {
2269 18c9b560 balrog
        case 1:
2270 18c9b560 balrog
            if (insn & (1 << 21))
2271 18c9b560 balrog
                gen_op_iwmmxt_packsw_M0_wRn(rd1);
2272 18c9b560 balrog
            else
2273 18c9b560 balrog
                gen_op_iwmmxt_packuw_M0_wRn(rd1);
2274 18c9b560 balrog
            break;
2275 18c9b560 balrog
        case 2:
2276 18c9b560 balrog
            if (insn & (1 << 21))
2277 18c9b560 balrog
                gen_op_iwmmxt_packsl_M0_wRn(rd1);
2278 18c9b560 balrog
            else
2279 18c9b560 balrog
                gen_op_iwmmxt_packul_M0_wRn(rd1);
2280 18c9b560 balrog
            break;
2281 18c9b560 balrog
        case 3:
2282 18c9b560 balrog
            if (insn & (1 << 21))
2283 18c9b560 balrog
                gen_op_iwmmxt_packsq_M0_wRn(rd1);
2284 18c9b560 balrog
            else
2285 18c9b560 balrog
                gen_op_iwmmxt_packuq_M0_wRn(rd1);
2286 18c9b560 balrog
            break;
2287 18c9b560 balrog
        }
2288 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2289 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2290 18c9b560 balrog
        gen_op_iwmmxt_set_cup();
2291 18c9b560 balrog
        break;
2292 18c9b560 balrog
    case 0x201: case 0x203: case 0x205: case 0x207:
2293 18c9b560 balrog
    case 0x209: case 0x20b: case 0x20d: case 0x20f:
2294 18c9b560 balrog
    case 0x211: case 0x213: case 0x215: case 0x217:
2295 18c9b560 balrog
    case 0x219: case 0x21b: case 0x21d: case 0x21f:
2296 18c9b560 balrog
        wrd = (insn >> 5) & 0xf;
2297 18c9b560 balrog
        rd0 = (insn >> 12) & 0xf;
2298 18c9b560 balrog
        rd1 = (insn >> 0) & 0xf;
2299 18c9b560 balrog
        if (rd0 == 0xf || rd1 == 0xf)
2300 18c9b560 balrog
            return 1;
2301 18c9b560 balrog
        gen_op_iwmmxt_movq_M0_wRn(wrd);
2302 da6b5335 Filip Navara
        tmp = load_reg(s, rd0);
2303 da6b5335 Filip Navara
        tmp2 = load_reg(s, rd1);
2304 18c9b560 balrog
        switch ((insn >> 16) & 0xf) {
2305 18c9b560 balrog
        case 0x0:                                        /* TMIA */
2306 da6b5335 Filip Navara
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2307 18c9b560 balrog
            break;
2308 18c9b560 balrog
        case 0x8:                                        /* TMIAPH */
2309 da6b5335 Filip Navara
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2310 18c9b560 balrog
            break;
2311 18c9b560 balrog
        case 0xc: case 0xd: case 0xe: case 0xf:                /* TMIAxy */
2312 18c9b560 balrog
            if (insn & (1 << 16))
2313 da6b5335 Filip Navara
                tcg_gen_shri_i32(tmp, tmp, 16);
2314 18c9b560 balrog
            if (insn & (1 << 17))
2315 da6b5335 Filip Navara
                tcg_gen_shri_i32(tmp2, tmp2, 16);
2316 da6b5335 Filip Navara
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2317 18c9b560 balrog
            break;
2318 18c9b560 balrog
        default:
2319 da6b5335 Filip Navara
            dead_tmp(tmp2);
2320 da6b5335 Filip Navara
            dead_tmp(tmp);
2321 18c9b560 balrog
            return 1;
2322 18c9b560 balrog
        }
2323 da6b5335 Filip Navara
        dead_tmp(tmp2);
2324 da6b5335 Filip Navara
        dead_tmp(tmp);
2325 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(wrd);
2326 18c9b560 balrog
        gen_op_iwmmxt_set_mup();
2327 18c9b560 balrog
        break;
2328 18c9b560 balrog
    default:
2329 18c9b560 balrog
        return 1;
2330 18c9b560 balrog
    }
2331 18c9b560 balrog
2332 18c9b560 balrog
    return 0;
2333 18c9b560 balrog
}
2334 18c9b560 balrog
2335 18c9b560 balrog
/* Disassemble an XScale DSP instruction.  Returns nonzero if an error occured
2336 18c9b560 balrog
   (ie. an undefined instruction).  */
2337 18c9b560 balrog
static int disas_dsp_insn(CPUState *env, DisasContext *s, uint32_t insn)
2338 18c9b560 balrog
{
2339 18c9b560 balrog
    int acc, rd0, rd1, rdhi, rdlo;
2340 3a554c0f Filip Navara
    TCGv tmp, tmp2;
2341 18c9b560 balrog
2342 18c9b560 balrog
    if ((insn & 0x0ff00f10) == 0x0e200010) {
2343 18c9b560 balrog
        /* Multiply with Internal Accumulate Format */
2344 18c9b560 balrog
        rd0 = (insn >> 12) & 0xf;
2345 18c9b560 balrog
        rd1 = insn & 0xf;
2346 18c9b560 balrog
        acc = (insn >> 5) & 7;
2347 18c9b560 balrog
2348 18c9b560 balrog
        if (acc != 0)
2349 18c9b560 balrog
            return 1;
2350 18c9b560 balrog
2351 3a554c0f Filip Navara
        tmp = load_reg(s, rd0);
2352 3a554c0f Filip Navara
        tmp2 = load_reg(s, rd1);
2353 18c9b560 balrog
        switch ((insn >> 16) & 0xf) {
2354 18c9b560 balrog
        case 0x0:                                        /* MIA */
2355 3a554c0f Filip Navara
            gen_helper_iwmmxt_muladdsl(cpu_M0, cpu_M0, tmp, tmp2);
2356 18c9b560 balrog
            break;
2357 18c9b560 balrog
        case 0x8:                                        /* MIAPH */
2358 3a554c0f Filip Navara
            gen_helper_iwmmxt_muladdsw(cpu_M0, cpu_M0, tmp, tmp2);
2359 18c9b560 balrog
            break;
2360 18c9b560 balrog
        case 0xc:                                        /* MIABB */
2361 18c9b560 balrog
        case 0xd:                                        /* MIABT */
2362 18c9b560 balrog
        case 0xe:                                        /* MIATB */
2363 18c9b560 balrog
        case 0xf:                                        /* MIATT */
2364 18c9b560 balrog
            if (insn & (1 << 16))
2365 3a554c0f Filip Navara
                tcg_gen_shri_i32(tmp, tmp, 16);
2366 18c9b560 balrog
            if (insn & (1 << 17))
2367 3a554c0f Filip Navara
                tcg_gen_shri_i32(tmp2, tmp2, 16);
2368 3a554c0f Filip Navara
            gen_helper_iwmmxt_muladdswl(cpu_M0, cpu_M0, tmp, tmp2);
2369 18c9b560 balrog
            break;
2370 18c9b560 balrog
        default:
2371 18c9b560 balrog
            return 1;
2372 18c9b560 balrog
        }
2373 3a554c0f Filip Navara
        dead_tmp(tmp2);
2374 3a554c0f Filip Navara
        dead_tmp(tmp);
2375 18c9b560 balrog
2376 18c9b560 balrog
        gen_op_iwmmxt_movq_wRn_M0(acc);
2377 18c9b560 balrog
        return 0;
2378 18c9b560 balrog
    }
2379 18c9b560 balrog
2380 18c9b560 balrog
    if ((insn & 0x0fe00ff8) == 0x0c400000) {
2381 18c9b560 balrog
        /* Internal Accumulator Access Format */
2382 18c9b560 balrog
        rdhi = (insn >> 16) & 0xf;
2383 18c9b560 balrog
        rdlo = (insn >> 12) & 0xf;
2384 18c9b560 balrog
        acc = insn & 7;
2385 18c9b560 balrog
2386 18c9b560 balrog
        if (acc != 0)
2387 18c9b560 balrog
            return 1;
2388 18c9b560 balrog
2389 18c9b560 balrog
        if (insn & ARM_CP_RW_BIT) {                        /* MRA */
2390 3a554c0f Filip Navara
            iwmmxt_load_reg(cpu_V0, acc);
2391 3a554c0f Filip Navara
            tcg_gen_trunc_i64_i32(cpu_R[rdlo], cpu_V0);
2392 3a554c0f Filip Navara
            tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
2393 3a554c0f Filip Navara
            tcg_gen_trunc_i64_i32(cpu_R[rdhi], cpu_V0);
2394 3a554c0f Filip Navara
            tcg_gen_andi_i32(cpu_R[rdhi], cpu_R[rdhi], (1 << (40 - 32)) - 1);
2395 18c9b560 balrog
        } else {                                        /* MAR */
2396 3a554c0f Filip Navara
            tcg_gen_concat_i32_i64(cpu_V0, cpu_R[rdlo], cpu_R[rdhi]);
2397 3a554c0f Filip Navara
            iwmmxt_store_reg(cpu_V0, acc);
2398 18c9b560 balrog
        }
2399 18c9b560 balrog
        return 0;
2400 18c9b560 balrog
    }
2401 18c9b560 balrog
2402 18c9b560 balrog
    return 1;
2403 18c9b560 balrog
}
2404 18c9b560 balrog
2405 c1713132 balrog
/* Disassemble system coprocessor instruction.  Return nonzero if
2406 c1713132 balrog
   instruction is not defined.  */
2407 c1713132 balrog
static int disas_cp_insn(CPUState *env, DisasContext *s, uint32_t insn)
2408 c1713132 balrog
{
2409 b75263d6 Juha Riihimรคki
    TCGv tmp, tmp2;
2410 c1713132 balrog
    uint32_t rd = (insn >> 12) & 0xf;
2411 c1713132 balrog
    uint32_t cp = (insn >> 8) & 0xf;
2412 c1713132 balrog
    if (IS_USER(s)) {
2413 c1713132 balrog
        return 1;
2414 c1713132 balrog
    }
2415 c1713132 balrog
2416 18c9b560 balrog
    if (insn & ARM_CP_RW_BIT) {
2417 c1713132 balrog
        if (!env->cp[cp].cp_read)
2418 c1713132 balrog
            return 1;
2419 8984bd2e pbrook
        gen_set_pc_im(s->pc);
2420 8984bd2e pbrook
        tmp = new_tmp();
2421 b75263d6 Juha Riihimรคki
        tmp2 = tcg_const_i32(insn);
2422 b75263d6 Juha Riihimรคki
        gen_helper_get_cp(tmp, cpu_env, tmp2);
2423 b75263d6 Juha Riihimรคki
        tcg_temp_free(tmp2);
2424 8984bd2e pbrook
        store_reg(s, rd, tmp);
2425 c1713132 balrog
    } else {
2426 c1713132 balrog
        if (!env->cp[cp].cp_write)
2427 c1713132 balrog
            return 1;
2428 8984bd2e pbrook
        gen_set_pc_im(s->pc);
2429 8984bd2e pbrook
        tmp = load_reg(s, rd);
2430 b75263d6 Juha Riihimรคki
        tmp2 = tcg_const_i32(insn);
2431 b75263d6 Juha Riihimรคki
        gen_helper_set_cp(cpu_env, tmp2, tmp);
2432 b75263d6 Juha Riihimรคki
        tcg_temp_free(tmp2);
2433 a60de947 balrog
        dead_tmp(tmp);
2434 c1713132 balrog
    }
2435 c1713132 balrog
    return 0;
2436 c1713132 balrog
}
2437 c1713132 balrog
2438 9ee6e8bb pbrook
static int cp15_user_ok(uint32_t insn)
2439 9ee6e8bb pbrook
{
2440 9ee6e8bb pbrook
    int cpn = (insn >> 16) & 0xf;
2441 9ee6e8bb pbrook
    int cpm = insn & 0xf;
2442 9ee6e8bb pbrook
    int op = ((insn >> 5) & 7) | ((insn >> 18) & 0x38);
2443 9ee6e8bb pbrook
2444 9ee6e8bb pbrook
    if (cpn == 13 && cpm == 0) {
2445 9ee6e8bb pbrook
        /* TLS register.  */
2446 9ee6e8bb pbrook
        if (op == 2 || (op == 3 && (insn & ARM_CP_RW_BIT)))
2447 9ee6e8bb pbrook
            return 1;
2448 9ee6e8bb pbrook
    }
2449 9ee6e8bb pbrook
    if (cpn == 7) {
2450 9ee6e8bb pbrook
        /* ISB, DSB, DMB.  */
2451 9ee6e8bb pbrook
        if ((cpm == 5 && op == 4)
2452 9ee6e8bb pbrook
                || (cpm == 10 && (op == 4 || op == 5)))
2453 9ee6e8bb pbrook
            return 1;
2454 9ee6e8bb pbrook
    }
2455 9ee6e8bb pbrook
    return 0;
2456 9ee6e8bb pbrook
}
2457 9ee6e8bb pbrook
2458 3f26c122 Riku Voipio
static int cp15_tls_load_store(CPUState *env, DisasContext *s, uint32_t insn, uint32_t rd)
2459 3f26c122 Riku Voipio
{
2460 3f26c122 Riku Voipio
    TCGv tmp;
2461 3f26c122 Riku Voipio
    int cpn = (insn >> 16) & 0xf;
2462 3f26c122 Riku Voipio
    int cpm = insn & 0xf;
2463 3f26c122 Riku Voipio
    int op = ((insn >> 5) & 7) | ((insn >> 18) & 0x38);
2464 3f26c122 Riku Voipio
2465 3f26c122 Riku Voipio
    if (!arm_feature(env, ARM_FEATURE_V6K))
2466 3f26c122 Riku Voipio
        return 0;
2467 3f26c122 Riku Voipio
2468 3f26c122 Riku Voipio
    if (!(cpn == 13 && cpm == 0))
2469 3f26c122 Riku Voipio
        return 0;
2470 3f26c122 Riku Voipio
2471 3f26c122 Riku Voipio
    if (insn & ARM_CP_RW_BIT) {
2472 3f26c122 Riku Voipio
        tmp = new_tmp();
2473 3f26c122 Riku Voipio
        switch (op) {
2474 3f26c122 Riku Voipio
        case 2:
2475 3f26c122 Riku Voipio
            tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls1));
2476 3f26c122 Riku Voipio
            break;
2477 3f26c122 Riku Voipio
        case 3:
2478 3f26c122 Riku Voipio
            tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls2));
2479 3f26c122 Riku Voipio
            break;
2480 3f26c122 Riku Voipio
        case 4:
2481 3f26c122 Riku Voipio
            tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls3));
2482 3f26c122 Riku Voipio
            break;
2483 3f26c122 Riku Voipio
        default:
2484 3f26c122 Riku Voipio
            dead_tmp(tmp);
2485 3f26c122 Riku Voipio
            return 0;
2486 3f26c122 Riku Voipio
        }
2487 3f26c122 Riku Voipio
        store_reg(s, rd, tmp);
2488 3f26c122 Riku Voipio
2489 3f26c122 Riku Voipio
    } else {
2490 3f26c122 Riku Voipio
        tmp = load_reg(s, rd);
2491 3f26c122 Riku Voipio
        switch (op) {
2492 3f26c122 Riku Voipio
        case 2:
2493 3f26c122 Riku Voipio
            tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls1));
2494 3f26c122 Riku Voipio
            break;
2495 3f26c122 Riku Voipio
        case 3:
2496 3f26c122 Riku Voipio
            tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls2));
2497 3f26c122 Riku Voipio
            break;
2498 3f26c122 Riku Voipio
        case 4:
2499 3f26c122 Riku Voipio
            tcg_gen_st_i32(tmp, cpu_env, offsetof(CPUARMState, cp15.c13_tls3));
2500 3f26c122 Riku Voipio
            break;
2501 3f26c122 Riku Voipio
        default:
2502 3f26c122 Riku Voipio
            return 0;
2503 3f26c122 Riku Voipio
        }
2504 3f26c122 Riku Voipio
        dead_tmp(tmp);
2505 3f26c122 Riku Voipio
    }
2506 3f26c122 Riku Voipio
    return 1;
2507 3f26c122 Riku Voipio
}
2508 3f26c122 Riku Voipio
2509 b5ff1b31 bellard
/* Disassemble system coprocessor (cp15) instruction.  Return nonzero if
2510 b5ff1b31 bellard
   instruction is not defined.  */
2511 a90b7318 balrog
static int disas_cp15_insn(CPUState *env, DisasContext *s, uint32_t insn)
2512 b5ff1b31 bellard
{
2513 b5ff1b31 bellard
    uint32_t rd;
2514 b75263d6 Juha Riihimรคki
    TCGv tmp, tmp2;
2515 b5ff1b31 bellard
2516 9ee6e8bb pbrook
    /* M profile cores use memory mapped registers instead of cp15.  */
2517 9ee6e8bb pbrook
    if (arm_feature(env, ARM_FEATURE_M))
2518 9ee6e8bb pbrook
        return 1;
2519 9ee6e8bb pbrook
2520 9ee6e8bb pbrook
    if ((insn & (1 << 25)) == 0) {
2521 9ee6e8bb pbrook
        if (insn & (1 << 20)) {
2522 9ee6e8bb pbrook
            /* mrrc */
2523 9ee6e8bb pbrook
            return 1;
2524 9ee6e8bb pbrook
        }
2525 9ee6e8bb pbrook
        /* mcrr.  Used for block cache operations, so implement as no-op.  */
2526 9ee6e8bb pbrook
        return 0;
2527 9ee6e8bb pbrook
    }
2528 9ee6e8bb pbrook
    if ((insn & (1 << 4)) == 0) {
2529 9ee6e8bb pbrook
        /* cdp */
2530 9ee6e8bb pbrook
        return 1;
2531 9ee6e8bb pbrook
    }
2532 9ee6e8bb pbrook
    if (IS_USER(s) && !cp15_user_ok(insn)) {
2533 b5ff1b31 bellard
        return 1;
2534 b5ff1b31 bellard
    }
2535 9332f9da bellard
    if ((insn & 0x0fff0fff) == 0x0e070f90
2536 9332f9da bellard
        || (insn & 0x0fff0fff) == 0x0e070f58) {
2537 9332f9da bellard
        /* Wait for interrupt.  */
2538 8984bd2e pbrook
        gen_set_pc_im(s->pc);
2539 9ee6e8bb pbrook
        s->is_jmp = DISAS_WFI;
2540 9332f9da bellard
        return 0;
2541 9332f9da bellard
    }
2542 b5ff1b31 bellard
    rd = (insn >> 12) & 0xf;
2543 3f26c122 Riku Voipio
2544 3f26c122 Riku Voipio
    if (cp15_tls_load_store(env, s, insn, rd))
2545 3f26c122 Riku Voipio
        return 0;
2546 3f26c122 Riku Voipio
2547 b75263d6 Juha Riihimรคki
    tmp2 = tcg_const_i32(insn);
2548 18c9b560 balrog
    if (insn & ARM_CP_RW_BIT) {
2549 8984bd2e pbrook
        tmp = new_tmp();
2550 b75263d6 Juha Riihimรคki
        gen_helper_get_cp15(tmp, cpu_env, tmp2);
2551 b5ff1b31 bellard
        /* If the destination register is r15 then sets condition codes.  */
2552 b5ff1b31 bellard
        if (rd != 15)
2553 8984bd2e pbrook
            store_reg(s, rd, tmp);
2554 8984bd2e pbrook
        else
2555 8984bd2e pbrook
            dead_tmp(tmp);
2556 b5ff1b31 bellard
    } else {
2557 8984bd2e pbrook
        tmp = load_reg(s, rd);
2558 b75263d6 Juha Riihimรคki
        gen_helper_set_cp15(cpu_env, tmp2, tmp);
2559 8984bd2e pbrook
        dead_tmp(tmp);
2560 a90b7318 balrog
        /* Normally we would always end the TB here, but Linux
2561 a90b7318 balrog
         * arch/arm/mach-pxa/sleep.S expects two instructions following
2562 a90b7318 balrog
         * an MMU enable to execute from cache.  Imitate this behaviour.  */
2563 a90b7318 balrog
        if (!arm_feature(env, ARM_FEATURE_XSCALE) ||
2564 a90b7318 balrog
                (insn & 0x0fff0fff) != 0x0e010f10)
2565 a90b7318 balrog
            gen_lookup_tb(s);
2566 b5ff1b31 bellard
    }
2567 b75263d6 Juha Riihimรคki
    tcg_temp_free_i32(tmp2);
2568 b5ff1b31 bellard
    return 0;
2569 b5ff1b31 bellard
}
2570 b5ff1b31 bellard
2571 9ee6e8bb pbrook
#define VFP_REG_SHR(x, n) (((n) > 0) ? (x) >> (n) : (x) << -(n))
2572 9ee6e8bb pbrook
#define VFP_SREG(insn, bigbit, smallbit) \
2573 9ee6e8bb pbrook
  ((VFP_REG_SHR(insn, bigbit - 1) & 0x1e) | (((insn) >> (smallbit)) & 1))
2574 9ee6e8bb pbrook
#define VFP_DREG(reg, insn, bigbit, smallbit) do { \
2575 9ee6e8bb pbrook
    if (arm_feature(env, ARM_FEATURE_VFP3)) { \
2576 9ee6e8bb pbrook
        reg = (((insn) >> (bigbit)) & 0x0f) \
2577 9ee6e8bb pbrook
              | (((insn) >> ((smallbit) - 4)) & 0x10); \
2578 9ee6e8bb pbrook
    } else { \
2579 9ee6e8bb pbrook
        if (insn & (1 << (smallbit))) \
2580 9ee6e8bb pbrook
            return 1; \
2581 9ee6e8bb pbrook
        reg = ((insn) >> (bigbit)) & 0x0f; \
2582 9ee6e8bb pbrook
    }} while (0)
2583 9ee6e8bb pbrook
2584 9ee6e8bb pbrook
#define VFP_SREG_D(insn) VFP_SREG(insn, 12, 22)
2585 9ee6e8bb pbrook
#define VFP_DREG_D(reg, insn) VFP_DREG(reg, insn, 12, 22)
2586 9ee6e8bb pbrook
#define VFP_SREG_N(insn) VFP_SREG(insn, 16,  7)
2587 9ee6e8bb pbrook
#define VFP_DREG_N(reg, insn) VFP_DREG(reg, insn, 16,  7)
2588 9ee6e8bb pbrook
#define VFP_SREG_M(insn) VFP_SREG(insn,  0,  5)
2589 9ee6e8bb pbrook
#define VFP_DREG_M(reg, insn) VFP_DREG(reg, insn,  0,  5)
2590 9ee6e8bb pbrook
2591 4373f3ce pbrook
/* Move between integer and VFP cores.  */
2592 4373f3ce pbrook
static TCGv gen_vfp_mrs(void)
2593 4373f3ce pbrook
{
2594 4373f3ce pbrook
    TCGv tmp = new_tmp();
2595 4373f3ce pbrook
    tcg_gen_mov_i32(tmp, cpu_F0s);
2596 4373f3ce pbrook
    return tmp;
2597 4373f3ce pbrook
}
2598 4373f3ce pbrook
2599 4373f3ce pbrook
static void gen_vfp_msr(TCGv tmp)
2600 4373f3ce pbrook
{
2601 4373f3ce pbrook
    tcg_gen_mov_i32(cpu_F0s, tmp);
2602 4373f3ce pbrook
    dead_tmp(tmp);
2603 4373f3ce pbrook
}
2604 4373f3ce pbrook
2605 9ee6e8bb pbrook
static inline int
2606 9ee6e8bb pbrook
vfp_enabled(CPUState * env)
2607 9ee6e8bb pbrook
{
2608 9ee6e8bb pbrook
    return ((env->vfp.xregs[ARM_VFP_FPEXC] & (1 << 30)) != 0);
2609 9ee6e8bb pbrook
}
2610 9ee6e8bb pbrook
2611 ad69471c pbrook
static void gen_neon_dup_u8(TCGv var, int shift)
2612 ad69471c pbrook
{
2613 ad69471c pbrook
    TCGv tmp = new_tmp();
2614 ad69471c pbrook
    if (shift)
2615 ad69471c pbrook
        tcg_gen_shri_i32(var, var, shift);
2616 86831435 pbrook
    tcg_gen_ext8u_i32(var, var);
2617 ad69471c pbrook
    tcg_gen_shli_i32(tmp, var, 8);
2618 ad69471c pbrook
    tcg_gen_or_i32(var, var, tmp);
2619 ad69471c pbrook
    tcg_gen_shli_i32(tmp, var, 16);
2620 ad69471c pbrook
    tcg_gen_or_i32(var, var, tmp);
2621 ad69471c pbrook
    dead_tmp(tmp);
2622 ad69471c pbrook
}
2623 ad69471c pbrook
2624 ad69471c pbrook
static void gen_neon_dup_low16(TCGv var)
2625 ad69471c pbrook
{
2626 ad69471c pbrook
    TCGv tmp = new_tmp();
2627 86831435 pbrook
    tcg_gen_ext16u_i32(var, var);
2628 ad69471c pbrook
    tcg_gen_shli_i32(tmp, var, 16);
2629 ad69471c pbrook
    tcg_gen_or_i32(var, var, tmp);
2630 ad69471c pbrook
    dead_tmp(tmp);
2631 ad69471c pbrook
}
2632 ad69471c pbrook
2633 ad69471c pbrook
static void gen_neon_dup_high16(TCGv var)
2634 ad69471c pbrook
{
2635 ad69471c pbrook
    TCGv tmp = new_tmp();
2636 ad69471c pbrook
    tcg_gen_andi_i32(var, var, 0xffff0000);
2637 ad69471c pbrook
    tcg_gen_shri_i32(tmp, var, 16);
2638 ad69471c pbrook
    tcg_gen_or_i32(var, var, tmp);
2639 ad69471c pbrook
    dead_tmp(tmp);
2640 ad69471c pbrook
}
2641 ad69471c pbrook
2642 b7bcbe95 bellard
/* Disassemble a VFP instruction.  Returns nonzero if an error occured
2643 b7bcbe95 bellard
   (ie. an undefined instruction).  */
2644 b7bcbe95 bellard
static int disas_vfp_insn(CPUState * env, DisasContext *s, uint32_t insn)
2645 b7bcbe95 bellard
{
2646 b7bcbe95 bellard
    uint32_t rd, rn, rm, op, i, n, offset, delta_d, delta_m, bank_mask;
2647 b7bcbe95 bellard
    int dp, veclen;
2648 312eea9f Filip Navara
    TCGv addr;
2649 4373f3ce pbrook
    TCGv tmp;
2650 ad69471c pbrook
    TCGv tmp2;
2651 b7bcbe95 bellard
2652 40f137e1 pbrook
    if (!arm_feature(env, ARM_FEATURE_VFP))
2653 40f137e1 pbrook
        return 1;
2654 40f137e1 pbrook
2655 9ee6e8bb pbrook
    if (!vfp_enabled(env)) {
2656 9ee6e8bb pbrook
        /* VFP disabled.  Only allow fmxr/fmrx to/from some control regs.  */
2657 40f137e1 pbrook
        if ((insn & 0x0fe00fff) != 0x0ee00a10)
2658 40f137e1 pbrook
            return 1;
2659 40f137e1 pbrook
        rn = (insn >> 16) & 0xf;
2660 9ee6e8bb pbrook
        if (rn != ARM_VFP_FPSID && rn != ARM_VFP_FPEXC
2661 9ee6e8bb pbrook
            && rn != ARM_VFP_MVFR1 && rn != ARM_VFP_MVFR0)
2662 40f137e1 pbrook
            return 1;
2663 40f137e1 pbrook
    }
2664 b7bcbe95 bellard
    dp = ((insn & 0xf00) == 0xb00);
2665 b7bcbe95 bellard
    switch ((insn >> 24) & 0xf) {
2666 b7bcbe95 bellard
    case 0xe:
2667 b7bcbe95 bellard
        if (insn & (1 << 4)) {
2668 b7bcbe95 bellard
            /* single register transfer */
2669 b7bcbe95 bellard
            rd = (insn >> 12) & 0xf;
2670 b7bcbe95 bellard
            if (dp) {
2671 9ee6e8bb pbrook
                int size;
2672 9ee6e8bb pbrook
                int pass;
2673 9ee6e8bb pbrook
2674 9ee6e8bb pbrook
                VFP_DREG_N(rn, insn);
2675 9ee6e8bb pbrook
                if (insn & 0xf)
2676 b7bcbe95 bellard
                    return 1;
2677 9ee6e8bb pbrook
                if (insn & 0x00c00060
2678 9ee6e8bb pbrook
                    && !arm_feature(env, ARM_FEATURE_NEON))
2679 9ee6e8bb pbrook
                    return 1;
2680 9ee6e8bb pbrook
2681 9ee6e8bb pbrook
                pass = (insn >> 21) & 1;
2682 9ee6e8bb pbrook
                if (insn & (1 << 22)) {
2683 9ee6e8bb pbrook
                    size = 0;
2684 9ee6e8bb pbrook
                    offset = ((insn >> 5) & 3) * 8;
2685 9ee6e8bb pbrook
                } else if (insn & (1 << 5)) {
2686 9ee6e8bb pbrook
                    size = 1;
2687 9ee6e8bb pbrook
                    offset = (insn & (1 << 6)) ? 16 : 0;
2688 9ee6e8bb pbrook
                } else {
2689 9ee6e8bb pbrook
                    size = 2;
2690 9ee6e8bb pbrook
                    offset = 0;
2691 9ee6e8bb pbrook
                }
2692 18c9b560 balrog
                if (insn & ARM_CP_RW_BIT) {
2693 b7bcbe95 bellard
                    /* vfp->arm */
2694 ad69471c pbrook
                    tmp = neon_load_reg(rn, pass);
2695 9ee6e8bb pbrook
                    switch (size) {
2696 9ee6e8bb pbrook
                    case 0:
2697 9ee6e8bb pbrook
                        if (offset)
2698 ad69471c pbrook
                            tcg_gen_shri_i32(tmp, tmp, offset);
2699 9ee6e8bb pbrook
                        if (insn & (1 << 23))
2700 ad69471c pbrook
                            gen_uxtb(tmp);
2701 9ee6e8bb pbrook
                        else
2702 ad69471c pbrook
                            gen_sxtb(tmp);
2703 9ee6e8bb pbrook
                        break;
2704 9ee6e8bb pbrook
                    case 1:
2705 9ee6e8bb pbrook
                        if (insn & (1 << 23)) {
2706 9ee6e8bb pbrook
                            if (offset) {
2707 ad69471c pbrook
                                tcg_gen_shri_i32(tmp, tmp, 16);
2708 9ee6e8bb pbrook
                            } else {
2709 ad69471c pbrook
                                gen_uxth(tmp);
2710 9ee6e8bb pbrook
                            }
2711 9ee6e8bb pbrook
                        } else {
2712 9ee6e8bb pbrook
                            if (offset) {
2713 ad69471c pbrook
                                tcg_gen_sari_i32(tmp, tmp, 16);
2714 9ee6e8bb pbrook
                            } else {
2715 ad69471c pbrook
                                gen_sxth(tmp);
2716 9ee6e8bb pbrook
                            }
2717 9ee6e8bb pbrook
                        }
2718 9ee6e8bb pbrook
                        break;
2719 9ee6e8bb pbrook
                    case 2:
2720 9ee6e8bb pbrook
                        break;
2721 9ee6e8bb pbrook
                    }
2722 ad69471c pbrook
                    store_reg(s, rd, tmp);
2723 b7bcbe95 bellard
                } else {
2724 b7bcbe95 bellard
                    /* arm->vfp */
2725 ad69471c pbrook
                    tmp = load_reg(s, rd);
2726 9ee6e8bb pbrook
                    if (insn & (1 << 23)) {
2727 9ee6e8bb pbrook
                        /* VDUP */
2728 9ee6e8bb pbrook
                        if (size == 0) {
2729 ad69471c pbrook
                            gen_neon_dup_u8(tmp, 0);
2730 9ee6e8bb pbrook
                        } else if (size == 1) {
2731 ad69471c pbrook
                            gen_neon_dup_low16(tmp);
2732 9ee6e8bb pbrook
                        }
2733 cbbccffc pbrook
                        for (n = 0; n <= pass * 2; n++) {
2734 cbbccffc pbrook
                            tmp2 = new_tmp();
2735 cbbccffc pbrook
                            tcg_gen_mov_i32(tmp2, tmp);
2736 cbbccffc pbrook
                            neon_store_reg(rn, n, tmp2);
2737 cbbccffc pbrook
                        }
2738 cbbccffc pbrook
                        neon_store_reg(rn, n, tmp);
2739 9ee6e8bb pbrook
                    } else {
2740 9ee6e8bb pbrook
                        /* VMOV */
2741 9ee6e8bb pbrook
                        switch (size) {
2742 9ee6e8bb pbrook
                        case 0:
2743 ad69471c pbrook
                            tmp2 = neon_load_reg(rn, pass);
2744 ad69471c pbrook
                            gen_bfi(tmp, tmp2, tmp, offset, 0xff);
2745 ad69471c pbrook
                            dead_tmp(tmp2);
2746 9ee6e8bb pbrook
                            break;
2747 9ee6e8bb pbrook
                        case 1:
2748 ad69471c pbrook
                            tmp2 = neon_load_reg(rn, pass);
2749 ad69471c pbrook
                            gen_bfi(tmp, tmp2, tmp, offset, 0xffff);
2750 ad69471c pbrook
                            dead_tmp(tmp2);
2751 9ee6e8bb pbrook
                            break;
2752 9ee6e8bb pbrook
                        case 2:
2753 9ee6e8bb pbrook
                            break;
2754 9ee6e8bb pbrook
                        }
2755 ad69471c pbrook
                        neon_store_reg(rn, pass, tmp);
2756 9ee6e8bb pbrook
                    }
2757 b7bcbe95 bellard
                }
2758 9ee6e8bb pbrook
            } else { /* !dp */
2759 9ee6e8bb pbrook
                if ((insn & 0x6f) != 0x00)
2760 9ee6e8bb pbrook
                    return 1;
2761 9ee6e8bb pbrook
                rn = VFP_SREG_N(insn);
2762 18c9b560 balrog
                if (insn & ARM_CP_RW_BIT) {
2763 b7bcbe95 bellard
                    /* vfp->arm */
2764 b7bcbe95 bellard
                    if (insn & (1 << 21)) {
2765 b7bcbe95 bellard
                        /* system register */
2766 40f137e1 pbrook
                        rn >>= 1;
2767 9ee6e8bb pbrook
2768 b7bcbe95 bellard
                        switch (rn) {
2769 40f137e1 pbrook
                        case ARM_VFP_FPSID:
2770 4373f3ce pbrook
                            /* VFP2 allows access to FSID from userspace.
2771 9ee6e8bb pbrook
                               VFP3 restricts all id registers to privileged
2772 9ee6e8bb pbrook
                               accesses.  */
2773 9ee6e8bb pbrook
                            if (IS_USER(s)
2774 9ee6e8bb pbrook
                                && arm_feature(env, ARM_FEATURE_VFP3))
2775 9ee6e8bb pbrook
                                return 1;
2776 4373f3ce pbrook
                            tmp = load_cpu_field(vfp.xregs[rn]);
2777 9ee6e8bb pbrook
                            break;
2778 40f137e1 pbrook
                        case ARM_VFP_FPEXC:
2779 9ee6e8bb pbrook
                            if (IS_USER(s))
2780 9ee6e8bb pbrook
                                return 1;
2781 4373f3ce pbrook
                            tmp = load_cpu_field(vfp.xregs[rn]);
2782 9ee6e8bb pbrook
                            break;
2783 40f137e1 pbrook
                        case ARM_VFP_FPINST:
2784 40f137e1 pbrook
                        case ARM_VFP_FPINST2:
2785 9ee6e8bb pbrook
                            /* Not present in VFP3.  */
2786 9ee6e8bb pbrook
                            if (IS_USER(s)
2787 9ee6e8bb pbrook
                                || arm_feature(env, ARM_FEATURE_VFP3))
2788 9ee6e8bb pbrook
                                return 1;
2789 4373f3ce pbrook
                            tmp = load_cpu_field(vfp.xregs[rn]);
2790 b7bcbe95 bellard
                            break;
2791 40f137e1 pbrook
                        case ARM_VFP_FPSCR:
2792 601d70b9 balrog
                            if (rd == 15) {
2793 4373f3ce pbrook
                                tmp = load_cpu_field(vfp.xregs[ARM_VFP_FPSCR]);
2794 4373f3ce pbrook
                                tcg_gen_andi_i32(tmp, tmp, 0xf0000000);
2795 4373f3ce pbrook
                            } else {
2796 4373f3ce pbrook
                                tmp = new_tmp();
2797 4373f3ce pbrook
                                gen_helper_vfp_get_fpscr(tmp, cpu_env);
2798 4373f3ce pbrook
                            }
2799 b7bcbe95 bellard
                            break;
2800 9ee6e8bb pbrook
                        case ARM_VFP_MVFR0:
2801 9ee6e8bb pbrook
                        case ARM_VFP_MVFR1:
2802 9ee6e8bb pbrook
                            if (IS_USER(s)
2803 9ee6e8bb pbrook
                                || !arm_feature(env, ARM_FEATURE_VFP3))
2804 9ee6e8bb pbrook
                                return 1;
2805 4373f3ce pbrook
                            tmp = load_cpu_field(vfp.xregs[rn]);
2806 9ee6e8bb pbrook
                            break;
2807 b7bcbe95 bellard
                        default:
2808 b7bcbe95 bellard
                            return 1;
2809 b7bcbe95 bellard
                        }
2810 b7bcbe95 bellard
                    } else {
2811 b7bcbe95 bellard
                        gen_mov_F0_vreg(0, rn);
2812 4373f3ce pbrook
                        tmp = gen_vfp_mrs();
2813 b7bcbe95 bellard
                    }
2814 b7bcbe95 bellard
                    if (rd == 15) {
2815 b5ff1b31 bellard
                        /* Set the 4 flag bits in the CPSR.  */
2816 4373f3ce pbrook
                        gen_set_nzcv(tmp);
2817 4373f3ce pbrook
                        dead_tmp(tmp);
2818 4373f3ce pbrook
                    } else {
2819 4373f3ce pbrook
                        store_reg(s, rd, tmp);
2820 4373f3ce pbrook
                    }
2821 b7bcbe95 bellard
                } else {
2822 b7bcbe95 bellard
                    /* arm->vfp */
2823 4373f3ce pbrook
                    tmp = load_reg(s, rd);
2824 b7bcbe95 bellard
                    if (insn & (1 << 21)) {
2825 40f137e1 pbrook
                        rn >>= 1;
2826 b7bcbe95 bellard
                        /* system register */
2827 b7bcbe95 bellard
                        switch (rn) {
2828 40f137e1 pbrook
                        case ARM_VFP_FPSID:
2829 9ee6e8bb pbrook
                        case ARM_VFP_MVFR0:
2830 9ee6e8bb pbrook
                        case ARM_VFP_MVFR1:
2831 b7bcbe95 bellard
                            /* Writes are ignored.  */
2832 b7bcbe95 bellard
                            break;
2833 40f137e1 pbrook
                        case ARM_VFP_FPSCR:
2834 4373f3ce pbrook
                            gen_helper_vfp_set_fpscr(cpu_env, tmp);
2835 4373f3ce pbrook
                            dead_tmp(tmp);
2836 b5ff1b31 bellard
                            gen_lookup_tb(s);
2837 b7bcbe95 bellard
                            break;
2838 40f137e1 pbrook
                        case ARM_VFP_FPEXC:
2839 9ee6e8bb pbrook
                            if (IS_USER(s))
2840 9ee6e8bb pbrook
                                return 1;
2841 71b3c3de Juha Riihimรคki
                            /* TODO: VFP subarchitecture support.
2842 71b3c3de Juha Riihimรคki
                             * For now, keep the EN bit only */
2843 71b3c3de Juha Riihimรคki
                            tcg_gen_andi_i32(tmp, tmp, 1 << 30);
2844 4373f3ce pbrook
                            store_cpu_field(tmp, vfp.xregs[rn]);
2845 40f137e1 pbrook
                            gen_lookup_tb(s);
2846 40f137e1 pbrook
                            break;
2847 40f137e1 pbrook
                        case ARM_VFP_FPINST:
2848 40f137e1 pbrook
                        case ARM_VFP_FPINST2:
2849 4373f3ce pbrook
                            store_cpu_field(tmp, vfp.xregs[rn]);
2850 40f137e1 pbrook
                            break;
2851 b7bcbe95 bellard
                        default:
2852 b7bcbe95 bellard
                            return 1;
2853 b7bcbe95 bellard
                        }
2854 b7bcbe95 bellard
                    } else {
2855 4373f3ce pbrook
                        gen_vfp_msr(tmp);
2856 b7bcbe95 bellard
                        gen_mov_vreg_F0(0, rn);
2857 b7bcbe95 bellard
                    }
2858 b7bcbe95 bellard
                }
2859 b7bcbe95 bellard
            }
2860 b7bcbe95 bellard
        } else {
2861 b7bcbe95 bellard
            /* data processing */
2862 b7bcbe95 bellard
            /* The opcode is in bits 23, 21, 20 and 6.  */
2863 b7bcbe95 bellard
            op = ((insn >> 20) & 8) | ((insn >> 19) & 6) | ((insn >> 6) & 1);
2864 b7bcbe95 bellard
            if (dp) {
2865 b7bcbe95 bellard
                if (op == 15) {
2866 b7bcbe95 bellard
                    /* rn is opcode */
2867 b7bcbe95 bellard
                    rn = ((insn >> 15) & 0x1e) | ((insn >> 7) & 1);
2868 b7bcbe95 bellard
                } else {
2869 b7bcbe95 bellard
                    /* rn is register number */
2870 9ee6e8bb pbrook
                    VFP_DREG_N(rn, insn);
2871 b7bcbe95 bellard
                }
2872 b7bcbe95 bellard
2873 b7bcbe95 bellard
                if (op == 15 && (rn == 15 || rn > 17)) {
2874 b7bcbe95 bellard
                    /* Integer or single precision destination.  */
2875 9ee6e8bb pbrook
                    rd = VFP_SREG_D(insn);
2876 b7bcbe95 bellard
                } else {
2877 9ee6e8bb pbrook
                    VFP_DREG_D(rd, insn);
2878 b7bcbe95 bellard
                }
2879 b7bcbe95 bellard
2880 b7bcbe95 bellard
                if (op == 15 && (rn == 16 || rn == 17)) {
2881 b7bcbe95 bellard
                    /* Integer source.  */
2882 b7bcbe95 bellard
                    rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
2883 b7bcbe95 bellard
                } else {
2884 9ee6e8bb pbrook
                    VFP_DREG_M(rm, insn);
2885 b7bcbe95 bellard
                }
2886 b7bcbe95 bellard
            } else {
2887 9ee6e8bb pbrook
                rn = VFP_SREG_N(insn);
2888 b7bcbe95 bellard
                if (op == 15 && rn == 15) {
2889 b7bcbe95 bellard
                    /* Double precision destination.  */
2890 9ee6e8bb pbrook
                    VFP_DREG_D(rd, insn);
2891 9ee6e8bb pbrook
                } else {
2892 9ee6e8bb pbrook
                    rd = VFP_SREG_D(insn);
2893 9ee6e8bb pbrook
                }
2894 9ee6e8bb pbrook
                rm = VFP_SREG_M(insn);
2895 b7bcbe95 bellard
            }
2896 b7bcbe95 bellard
2897 b7bcbe95 bellard
            veclen = env->vfp.vec_len;
2898 b7bcbe95 bellard
            if (op == 15 && rn > 3)
2899 b7bcbe95 bellard
                veclen = 0;
2900 b7bcbe95 bellard
2901 b7bcbe95 bellard
            /* Shut up compiler warnings.  */
2902 b7bcbe95 bellard
            delta_m = 0;
2903 b7bcbe95 bellard
            delta_d = 0;
2904 b7bcbe95 bellard
            bank_mask = 0;
2905 3b46e624 ths
2906 b7bcbe95 bellard
            if (veclen > 0) {
2907 b7bcbe95 bellard
                if (dp)
2908 b7bcbe95 bellard
                    bank_mask = 0xc;
2909 b7bcbe95 bellard
                else
2910 b7bcbe95 bellard
                    bank_mask = 0x18;
2911 b7bcbe95 bellard
2912 b7bcbe95 bellard
                /* Figure out what type of vector operation this is.  */
2913 b7bcbe95 bellard
                if ((rd & bank_mask) == 0) {
2914 b7bcbe95 bellard
                    /* scalar */
2915 b7bcbe95 bellard
                    veclen = 0;
2916 b7bcbe95 bellard
                } else {
2917 b7bcbe95 bellard
                    if (dp)
2918 b7bcbe95 bellard
                        delta_d = (env->vfp.vec_stride >> 1) + 1;
2919 b7bcbe95 bellard
                    else
2920 b7bcbe95 bellard
                        delta_d = env->vfp.vec_stride + 1;
2921 b7bcbe95 bellard
2922 b7bcbe95 bellard
                    if ((rm & bank_mask) == 0) {
2923 b7bcbe95 bellard
                        /* mixed scalar/vector */
2924 b7bcbe95 bellard
                        delta_m = 0;
2925 b7bcbe95 bellard
                    } else {
2926 b7bcbe95 bellard
                        /* vector */
2927 b7bcbe95 bellard
                        delta_m = delta_d;
2928 b7bcbe95 bellard
                    }
2929 b7bcbe95 bellard
                }
2930 b7bcbe95 bellard
            }
2931 b7bcbe95 bellard
2932 b7bcbe95 bellard
            /* Load the initial operands.  */
2933 b7bcbe95 bellard
            if (op == 15) {
2934 b7bcbe95 bellard
                switch (rn) {
2935 b7bcbe95 bellard
                case 16:
2936 b7bcbe95 bellard
                case 17:
2937 b7bcbe95 bellard
                    /* Integer source */
2938 b7bcbe95 bellard
                    gen_mov_F0_vreg(0, rm);
2939 b7bcbe95 bellard
                    break;
2940 b7bcbe95 bellard
                case 8:
2941 b7bcbe95 bellard
                case 9:
2942 b7bcbe95 bellard
                    /* Compare */
2943 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rd);
2944 b7bcbe95 bellard
                    gen_mov_F1_vreg(dp, rm);
2945 b7bcbe95 bellard
                    break;
2946 b7bcbe95 bellard
                case 10:
2947 b7bcbe95 bellard
                case 11:
2948 b7bcbe95 bellard
                    /* Compare with zero */
2949 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rd);
2950 b7bcbe95 bellard
                    gen_vfp_F1_ld0(dp);
2951 b7bcbe95 bellard
                    break;
2952 9ee6e8bb pbrook
                case 20:
2953 9ee6e8bb pbrook
                case 21:
2954 9ee6e8bb pbrook
                case 22:
2955 9ee6e8bb pbrook
                case 23:
2956 644ad806 pbrook
                case 28:
2957 644ad806 pbrook
                case 29:
2958 644ad806 pbrook
                case 30:
2959 644ad806 pbrook
                case 31:
2960 9ee6e8bb pbrook
                    /* Source and destination the same.  */
2961 9ee6e8bb pbrook
                    gen_mov_F0_vreg(dp, rd);
2962 9ee6e8bb pbrook
                    break;
2963 b7bcbe95 bellard
                default:
2964 b7bcbe95 bellard
                    /* One source operand.  */
2965 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rm);
2966 9ee6e8bb pbrook
                    break;
2967 b7bcbe95 bellard
                }
2968 b7bcbe95 bellard
            } else {
2969 b7bcbe95 bellard
                /* Two source operands.  */
2970 b7bcbe95 bellard
                gen_mov_F0_vreg(dp, rn);
2971 b7bcbe95 bellard
                gen_mov_F1_vreg(dp, rm);
2972 b7bcbe95 bellard
            }
2973 b7bcbe95 bellard
2974 b7bcbe95 bellard
            for (;;) {
2975 b7bcbe95 bellard
                /* Perform the calculation.  */
2976 b7bcbe95 bellard
                switch (op) {
2977 b7bcbe95 bellard
                case 0: /* mac: fd + (fn * fm) */
2978 b7bcbe95 bellard
                    gen_vfp_mul(dp);
2979 b7bcbe95 bellard
                    gen_mov_F1_vreg(dp, rd);
2980 b7bcbe95 bellard
                    gen_vfp_add(dp);
2981 b7bcbe95 bellard
                    break;
2982 b7bcbe95 bellard
                case 1: /* nmac: fd - (fn * fm) */
2983 b7bcbe95 bellard
                    gen_vfp_mul(dp);
2984 b7bcbe95 bellard
                    gen_vfp_neg(dp);
2985 b7bcbe95 bellard
                    gen_mov_F1_vreg(dp, rd);
2986 b7bcbe95 bellard
                    gen_vfp_add(dp);
2987 b7bcbe95 bellard
                    break;
2988 b7bcbe95 bellard
                case 2: /* msc: -fd + (fn * fm) */
2989 b7bcbe95 bellard
                    gen_vfp_mul(dp);
2990 b7bcbe95 bellard
                    gen_mov_F1_vreg(dp, rd);
2991 b7bcbe95 bellard
                    gen_vfp_sub(dp);
2992 b7bcbe95 bellard
                    break;
2993 b7bcbe95 bellard
                case 3: /* nmsc: -fd - (fn * fm)  */
2994 b7bcbe95 bellard
                    gen_vfp_mul(dp);
2995 b7bcbe95 bellard
                    gen_vfp_neg(dp);
2996 c9fb531a pbrook
                    gen_mov_F1_vreg(dp, rd);
2997 c9fb531a pbrook
                    gen_vfp_sub(dp);
2998 b7bcbe95 bellard
                    break;
2999 b7bcbe95 bellard
                case 4: /* mul: fn * fm */
3000 b7bcbe95 bellard
                    gen_vfp_mul(dp);
3001 b7bcbe95 bellard
                    break;
3002 b7bcbe95 bellard
                case 5: /* nmul: -(fn * fm) */
3003 b7bcbe95 bellard
                    gen_vfp_mul(dp);
3004 b7bcbe95 bellard
                    gen_vfp_neg(dp);
3005 b7bcbe95 bellard
                    break;
3006 b7bcbe95 bellard
                case 6: /* add: fn + fm */
3007 b7bcbe95 bellard
                    gen_vfp_add(dp);
3008 b7bcbe95 bellard
                    break;
3009 b7bcbe95 bellard
                case 7: /* sub: fn - fm */
3010 b7bcbe95 bellard
                    gen_vfp_sub(dp);
3011 b7bcbe95 bellard
                    break;
3012 b7bcbe95 bellard
                case 8: /* div: fn / fm */
3013 b7bcbe95 bellard
                    gen_vfp_div(dp);
3014 b7bcbe95 bellard
                    break;
3015 9ee6e8bb pbrook
                case 14: /* fconst */
3016 9ee6e8bb pbrook
                    if (!arm_feature(env, ARM_FEATURE_VFP3))
3017 9ee6e8bb pbrook
                      return 1;
3018 9ee6e8bb pbrook
3019 9ee6e8bb pbrook
                    n = (insn << 12) & 0x80000000;
3020 9ee6e8bb pbrook
                    i = ((insn >> 12) & 0x70) | (insn & 0xf);
3021 9ee6e8bb pbrook
                    if (dp) {
3022 9ee6e8bb pbrook
                        if (i & 0x40)
3023 9ee6e8bb pbrook
                            i |= 0x3f80;
3024 9ee6e8bb pbrook
                        else
3025 9ee6e8bb pbrook
                            i |= 0x4000;
3026 9ee6e8bb pbrook
                        n |= i << 16;
3027 4373f3ce pbrook
                        tcg_gen_movi_i64(cpu_F0d, ((uint64_t)n) << 32);
3028 9ee6e8bb pbrook
                    } else {
3029 9ee6e8bb pbrook
                        if (i & 0x40)
3030 9ee6e8bb pbrook
                            i |= 0x780;
3031 9ee6e8bb pbrook
                        else
3032 9ee6e8bb pbrook
                            i |= 0x800;
3033 9ee6e8bb pbrook
                        n |= i << 19;
3034 5b340b51 balrog
                        tcg_gen_movi_i32(cpu_F0s, n);
3035 9ee6e8bb pbrook
                    }
3036 9ee6e8bb pbrook
                    break;
3037 b7bcbe95 bellard
                case 15: /* extension space */
3038 b7bcbe95 bellard
                    switch (rn) {
3039 b7bcbe95 bellard
                    case 0: /* cpy */
3040 b7bcbe95 bellard
                        /* no-op */
3041 b7bcbe95 bellard
                        break;
3042 b7bcbe95 bellard
                    case 1: /* abs */
3043 b7bcbe95 bellard
                        gen_vfp_abs(dp);
3044 b7bcbe95 bellard
                        break;
3045 b7bcbe95 bellard
                    case 2: /* neg */
3046 b7bcbe95 bellard
                        gen_vfp_neg(dp);
3047 b7bcbe95 bellard
                        break;
3048 b7bcbe95 bellard
                    case 3: /* sqrt */
3049 b7bcbe95 bellard
                        gen_vfp_sqrt(dp);
3050 b7bcbe95 bellard
                        break;
3051 60011498 Paul Brook
                    case 4: /* vcvtb.f32.f16 */
3052 60011498 Paul Brook
                        if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
3053 60011498 Paul Brook
                          return 1;
3054 60011498 Paul Brook
                        tmp = gen_vfp_mrs();
3055 60011498 Paul Brook
                        tcg_gen_ext16u_i32(tmp, tmp);
3056 60011498 Paul Brook
                        gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp, cpu_env);
3057 60011498 Paul Brook
                        dead_tmp(tmp);
3058 60011498 Paul Brook
                        break;
3059 60011498 Paul Brook
                    case 5: /* vcvtt.f32.f16 */
3060 60011498 Paul Brook
                        if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
3061 60011498 Paul Brook
                          return 1;
3062 60011498 Paul Brook
                        tmp = gen_vfp_mrs();
3063 60011498 Paul Brook
                        tcg_gen_shri_i32(tmp, tmp, 16);
3064 60011498 Paul Brook
                        gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp, cpu_env);
3065 60011498 Paul Brook
                        dead_tmp(tmp);
3066 60011498 Paul Brook
                        break;
3067 60011498 Paul Brook
                    case 6: /* vcvtb.f16.f32 */
3068 60011498 Paul Brook
                        if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
3069 60011498 Paul Brook
                          return 1;
3070 60011498 Paul Brook
                        tmp = new_tmp();
3071 60011498 Paul Brook
                        gen_helper_vfp_fcvt_f32_to_f16(tmp, cpu_F0s, cpu_env);
3072 60011498 Paul Brook
                        gen_mov_F0_vreg(0, rd);
3073 60011498 Paul Brook
                        tmp2 = gen_vfp_mrs();
3074 60011498 Paul Brook
                        tcg_gen_andi_i32(tmp2, tmp2, 0xffff0000);
3075 60011498 Paul Brook
                        tcg_gen_or_i32(tmp, tmp, tmp2);
3076 60011498 Paul Brook
                        dead_tmp(tmp2);
3077 60011498 Paul Brook
                        gen_vfp_msr(tmp);
3078 60011498 Paul Brook
                        break;
3079 60011498 Paul Brook
                    case 7: /* vcvtt.f16.f32 */
3080 60011498 Paul Brook
                        if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
3081 60011498 Paul Brook
                          return 1;
3082 60011498 Paul Brook
                        tmp = new_tmp();
3083 60011498 Paul Brook
                        gen_helper_vfp_fcvt_f32_to_f16(tmp, cpu_F0s, cpu_env);
3084 60011498 Paul Brook
                        tcg_gen_shli_i32(tmp, tmp, 16);
3085 60011498 Paul Brook
                        gen_mov_F0_vreg(0, rd);
3086 60011498 Paul Brook
                        tmp2 = gen_vfp_mrs();
3087 60011498 Paul Brook
                        tcg_gen_ext16u_i32(tmp2, tmp2);
3088 60011498 Paul Brook
                        tcg_gen_or_i32(tmp, tmp, tmp2);
3089 60011498 Paul Brook
                        dead_tmp(tmp2);
3090 60011498 Paul Brook
                        gen_vfp_msr(tmp);
3091 60011498 Paul Brook
                        break;
3092 b7bcbe95 bellard
                    case 8: /* cmp */
3093 b7bcbe95 bellard
                        gen_vfp_cmp(dp);
3094 b7bcbe95 bellard
                        break;
3095 b7bcbe95 bellard
                    case 9: /* cmpe */
3096 b7bcbe95 bellard
                        gen_vfp_cmpe(dp);
3097 b7bcbe95 bellard
                        break;
3098 b7bcbe95 bellard
                    case 10: /* cmpz */
3099 b7bcbe95 bellard
                        gen_vfp_cmp(dp);
3100 b7bcbe95 bellard
                        break;
3101 b7bcbe95 bellard
                    case 11: /* cmpez */
3102 b7bcbe95 bellard
                        gen_vfp_F1_ld0(dp);
3103 b7bcbe95 bellard
                        gen_vfp_cmpe(dp);
3104 b7bcbe95 bellard
                        break;
3105 b7bcbe95 bellard
                    case 15: /* single<->double conversion */
3106 b7bcbe95 bellard
                        if (dp)
3107 4373f3ce pbrook
                            gen_helper_vfp_fcvtsd(cpu_F0s, cpu_F0d, cpu_env);
3108 b7bcbe95 bellard
                        else
3109 4373f3ce pbrook
                            gen_helper_vfp_fcvtds(cpu_F0d, cpu_F0s, cpu_env);
3110 b7bcbe95 bellard
                        break;
3111 b7bcbe95 bellard
                    case 16: /* fuito */
3112 b7bcbe95 bellard
                        gen_vfp_uito(dp);
3113 b7bcbe95 bellard
                        break;
3114 b7bcbe95 bellard
                    case 17: /* fsito */
3115 b7bcbe95 bellard
                        gen_vfp_sito(dp);
3116 b7bcbe95 bellard
                        break;
3117 9ee6e8bb pbrook
                    case 20: /* fshto */
3118 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3119 9ee6e8bb pbrook
                          return 1;
3120 644ad806 pbrook
                        gen_vfp_shto(dp, 16 - rm);
3121 9ee6e8bb pbrook
                        break;
3122 9ee6e8bb pbrook
                    case 21: /* fslto */
3123 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3124 9ee6e8bb pbrook
                          return 1;
3125 644ad806 pbrook
                        gen_vfp_slto(dp, 32 - rm);
3126 9ee6e8bb pbrook
                        break;
3127 9ee6e8bb pbrook
                    case 22: /* fuhto */
3128 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3129 9ee6e8bb pbrook
                          return 1;
3130 644ad806 pbrook
                        gen_vfp_uhto(dp, 16 - rm);
3131 9ee6e8bb pbrook
                        break;
3132 9ee6e8bb pbrook
                    case 23: /* fulto */
3133 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3134 9ee6e8bb pbrook
                          return 1;
3135 644ad806 pbrook
                        gen_vfp_ulto(dp, 32 - rm);
3136 9ee6e8bb pbrook
                        break;
3137 b7bcbe95 bellard
                    case 24: /* ftoui */
3138 b7bcbe95 bellard
                        gen_vfp_toui(dp);
3139 b7bcbe95 bellard
                        break;
3140 b7bcbe95 bellard
                    case 25: /* ftouiz */
3141 b7bcbe95 bellard
                        gen_vfp_touiz(dp);
3142 b7bcbe95 bellard
                        break;
3143 b7bcbe95 bellard
                    case 26: /* ftosi */
3144 b7bcbe95 bellard
                        gen_vfp_tosi(dp);
3145 b7bcbe95 bellard
                        break;
3146 b7bcbe95 bellard
                    case 27: /* ftosiz */
3147 b7bcbe95 bellard
                        gen_vfp_tosiz(dp);
3148 b7bcbe95 bellard
                        break;
3149 9ee6e8bb pbrook
                    case 28: /* ftosh */
3150 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3151 9ee6e8bb pbrook
                          return 1;
3152 644ad806 pbrook
                        gen_vfp_tosh(dp, 16 - rm);
3153 9ee6e8bb pbrook
                        break;
3154 9ee6e8bb pbrook
                    case 29: /* ftosl */
3155 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3156 9ee6e8bb pbrook
                          return 1;
3157 644ad806 pbrook
                        gen_vfp_tosl(dp, 32 - rm);
3158 9ee6e8bb pbrook
                        break;
3159 9ee6e8bb pbrook
                    case 30: /* ftouh */
3160 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3161 9ee6e8bb pbrook
                          return 1;
3162 644ad806 pbrook
                        gen_vfp_touh(dp, 16 - rm);
3163 9ee6e8bb pbrook
                        break;
3164 9ee6e8bb pbrook
                    case 31: /* ftoul */
3165 9ee6e8bb pbrook
                        if (!arm_feature(env, ARM_FEATURE_VFP3))
3166 9ee6e8bb pbrook
                          return 1;
3167 644ad806 pbrook
                        gen_vfp_toul(dp, 32 - rm);
3168 9ee6e8bb pbrook
                        break;
3169 b7bcbe95 bellard
                    default: /* undefined */
3170 b7bcbe95 bellard
                        printf ("rn:%d\n", rn);
3171 b7bcbe95 bellard
                        return 1;
3172 b7bcbe95 bellard
                    }
3173 b7bcbe95 bellard
                    break;
3174 b7bcbe95 bellard
                default: /* undefined */
3175 b7bcbe95 bellard
                    printf ("op:%d\n", op);
3176 b7bcbe95 bellard
                    return 1;
3177 b7bcbe95 bellard
                }
3178 b7bcbe95 bellard
3179 b7bcbe95 bellard
                /* Write back the result.  */
3180 b7bcbe95 bellard
                if (op == 15 && (rn >= 8 && rn <= 11))
3181 b7bcbe95 bellard
                    ; /* Comparison, do nothing.  */
3182 b7bcbe95 bellard
                else if (op == 15 && rn > 17)
3183 b7bcbe95 bellard
                    /* Integer result.  */
3184 b7bcbe95 bellard
                    gen_mov_vreg_F0(0, rd);
3185 b7bcbe95 bellard
                else if (op == 15 && rn == 15)
3186 b7bcbe95 bellard
                    /* conversion */
3187 b7bcbe95 bellard
                    gen_mov_vreg_F0(!dp, rd);
3188 b7bcbe95 bellard
                else
3189 b7bcbe95 bellard
                    gen_mov_vreg_F0(dp, rd);
3190 b7bcbe95 bellard
3191 b7bcbe95 bellard
                /* break out of the loop if we have finished  */
3192 b7bcbe95 bellard
                if (veclen == 0)
3193 b7bcbe95 bellard
                    break;
3194 b7bcbe95 bellard
3195 b7bcbe95 bellard
                if (op == 15 && delta_m == 0) {
3196 b7bcbe95 bellard
                    /* single source one-many */
3197 b7bcbe95 bellard
                    while (veclen--) {
3198 b7bcbe95 bellard
                        rd = ((rd + delta_d) & (bank_mask - 1))
3199 b7bcbe95 bellard
                             | (rd & bank_mask);
3200 b7bcbe95 bellard
                        gen_mov_vreg_F0(dp, rd);
3201 b7bcbe95 bellard
                    }
3202 b7bcbe95 bellard
                    break;
3203 b7bcbe95 bellard
                }
3204 b7bcbe95 bellard
                /* Setup the next operands.  */
3205 b7bcbe95 bellard
                veclen--;
3206 b7bcbe95 bellard
                rd = ((rd + delta_d) & (bank_mask - 1))
3207 b7bcbe95 bellard
                     | (rd & bank_mask);
3208 b7bcbe95 bellard
3209 b7bcbe95 bellard
                if (op == 15) {
3210 b7bcbe95 bellard
                    /* One source operand.  */
3211 b7bcbe95 bellard
                    rm = ((rm + delta_m) & (bank_mask - 1))
3212 b7bcbe95 bellard
                         | (rm & bank_mask);
3213 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rm);
3214 b7bcbe95 bellard
                } else {
3215 b7bcbe95 bellard
                    /* Two source operands.  */
3216 b7bcbe95 bellard
                    rn = ((rn + delta_d) & (bank_mask - 1))
3217 b7bcbe95 bellard
                         | (rn & bank_mask);
3218 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rn);
3219 b7bcbe95 bellard
                    if (delta_m) {
3220 b7bcbe95 bellard
                        rm = ((rm + delta_m) & (bank_mask - 1))
3221 b7bcbe95 bellard
                             | (rm & bank_mask);
3222 b7bcbe95 bellard
                        gen_mov_F1_vreg(dp, rm);
3223 b7bcbe95 bellard
                    }
3224 b7bcbe95 bellard
                }
3225 b7bcbe95 bellard
            }
3226 b7bcbe95 bellard
        }
3227 b7bcbe95 bellard
        break;
3228 b7bcbe95 bellard
    case 0xc:
3229 b7bcbe95 bellard
    case 0xd:
3230 9ee6e8bb pbrook
        if (dp && (insn & 0x03e00000) == 0x00400000) {
3231 b7bcbe95 bellard
            /* two-register transfer */
3232 b7bcbe95 bellard
            rn = (insn >> 16) & 0xf;
3233 b7bcbe95 bellard
            rd = (insn >> 12) & 0xf;
3234 b7bcbe95 bellard
            if (dp) {
3235 9ee6e8bb pbrook
                VFP_DREG_M(rm, insn);
3236 9ee6e8bb pbrook
            } else {
3237 9ee6e8bb pbrook
                rm = VFP_SREG_M(insn);
3238 9ee6e8bb pbrook
            }
3239 b7bcbe95 bellard
3240 18c9b560 balrog
            if (insn & ARM_CP_RW_BIT) {
3241 b7bcbe95 bellard
                /* vfp->arm */
3242 b7bcbe95 bellard
                if (dp) {
3243 4373f3ce pbrook
                    gen_mov_F0_vreg(0, rm * 2);
3244 4373f3ce pbrook
                    tmp = gen_vfp_mrs();
3245 4373f3ce pbrook
                    store_reg(s, rd, tmp);
3246 4373f3ce pbrook
                    gen_mov_F0_vreg(0, rm * 2 + 1);
3247 4373f3ce pbrook
                    tmp = gen_vfp_mrs();
3248 4373f3ce pbrook
                    store_reg(s, rn, tmp);
3249 b7bcbe95 bellard
                } else {
3250 b7bcbe95 bellard
                    gen_mov_F0_vreg(0, rm);
3251 4373f3ce pbrook
                    tmp = gen_vfp_mrs();
3252 4373f3ce pbrook
                    store_reg(s, rn, tmp);
3253 b7bcbe95 bellard
                    gen_mov_F0_vreg(0, rm + 1);
3254 4373f3ce pbrook
                    tmp = gen_vfp_mrs();
3255 4373f3ce pbrook
                    store_reg(s, rd, tmp);
3256 b7bcbe95 bellard
                }
3257 b7bcbe95 bellard
            } else {
3258 b7bcbe95 bellard
                /* arm->vfp */
3259 b7bcbe95 bellard
                if (dp) {
3260 4373f3ce pbrook
                    tmp = load_reg(s, rd);
3261 4373f3ce pbrook
                    gen_vfp_msr(tmp);
3262 4373f3ce pbrook
                    gen_mov_vreg_F0(0, rm * 2);
3263 4373f3ce pbrook
                    tmp = load_reg(s, rn);
3264 4373f3ce pbrook
                    gen_vfp_msr(tmp);
3265 4373f3ce pbrook
                    gen_mov_vreg_F0(0, rm * 2 + 1);
3266 b7bcbe95 bellard
                } else {
3267 4373f3ce pbrook
                    tmp = load_reg(s, rn);
3268 4373f3ce pbrook
                    gen_vfp_msr(tmp);
3269 b7bcbe95 bellard
                    gen_mov_vreg_F0(0, rm);
3270 4373f3ce pbrook
                    tmp = load_reg(s, rd);
3271 4373f3ce pbrook
                    gen_vfp_msr(tmp);
3272 b7bcbe95 bellard
                    gen_mov_vreg_F0(0, rm + 1);
3273 b7bcbe95 bellard
                }
3274 b7bcbe95 bellard
            }
3275 b7bcbe95 bellard
        } else {
3276 b7bcbe95 bellard
            /* Load/store */
3277 b7bcbe95 bellard
            rn = (insn >> 16) & 0xf;
3278 b7bcbe95 bellard
            if (dp)
3279 9ee6e8bb pbrook
                VFP_DREG_D(rd, insn);
3280 b7bcbe95 bellard
            else
3281 9ee6e8bb pbrook
                rd = VFP_SREG_D(insn);
3282 9ee6e8bb pbrook
            if (s->thumb && rn == 15) {
3283 312eea9f Filip Navara
                addr = new_tmp();
3284 312eea9f Filip Navara
                tcg_gen_movi_i32(addr, s->pc & ~2);
3285 9ee6e8bb pbrook
            } else {
3286 312eea9f Filip Navara
                addr = load_reg(s, rn);
3287 9ee6e8bb pbrook
            }
3288 b7bcbe95 bellard
            if ((insn & 0x01200000) == 0x01000000) {
3289 b7bcbe95 bellard
                /* Single load/store */
3290 b7bcbe95 bellard
                offset = (insn & 0xff) << 2;
3291 b7bcbe95 bellard
                if ((insn & (1 << 23)) == 0)
3292 b7bcbe95 bellard
                    offset = -offset;
3293 312eea9f Filip Navara
                tcg_gen_addi_i32(addr, addr, offset);
3294 b7bcbe95 bellard
                if (insn & (1 << 20)) {
3295 312eea9f Filip Navara
                    gen_vfp_ld(s, dp, addr);
3296 b7bcbe95 bellard
                    gen_mov_vreg_F0(dp, rd);
3297 b7bcbe95 bellard
                } else {
3298 b7bcbe95 bellard
                    gen_mov_F0_vreg(dp, rd);
3299 312eea9f Filip Navara
                    gen_vfp_st(s, dp, addr);
3300 b7bcbe95 bellard
                }
3301 312eea9f Filip Navara
                dead_tmp(addr);
3302 b7bcbe95 bellard
            } else {
3303 b7bcbe95 bellard
                /* load/store multiple */
3304 b7bcbe95 bellard
                if (dp)
3305 b7bcbe95 bellard
                    n = (insn >> 1) & 0x7f;
3306 b7bcbe95 bellard
                else
3307 b7bcbe95 bellard
                    n = insn & 0xff;
3308 b7bcbe95 bellard
3309 b7bcbe95 bellard
                if (insn & (1 << 24)) /* pre-decrement */
3310 312eea9f Filip Navara
                    tcg_gen_addi_i32(addr, addr, -((insn & 0xff) << 2));
3311 b7bcbe95 bellard
3312 b7bcbe95 bellard
                if (dp)
3313 b7bcbe95 bellard
                    offset = 8;
3314 b7bcbe95 bellard
                else
3315 b7bcbe95 bellard
                    offset = 4;
3316 b7bcbe95 bellard
                for (i = 0; i < n; i++) {
3317 18c9b560 balrog
                    if (insn & ARM_CP_RW_BIT) {
3318 b7bcbe95 bellard
                        /* load */
3319 312eea9f Filip Navara
                        gen_vfp_ld(s, dp, addr);
3320 b7bcbe95 bellard
                        gen_mov_vreg_F0(dp, rd + i);
3321 b7bcbe95 bellard
                    } else {
3322 b7bcbe95 bellard
                        /* store */
3323 b7bcbe95 bellard
                        gen_mov_F0_vreg(dp, rd + i);
3324 312eea9f Filip Navara
                        gen_vfp_st(s, dp, addr);
3325 b7bcbe95 bellard
                    }
3326 312eea9f Filip Navara
                    tcg_gen_addi_i32(addr, addr, offset);
3327 b7bcbe95 bellard
                }
3328 b7bcbe95 bellard
                if (insn & (1 << 21)) {
3329 b7bcbe95 bellard
                    /* writeback */
3330 b7bcbe95 bellard
                    if (insn & (1 << 24))
3331 b7bcbe95 bellard
                        offset = -offset * n;
3332 b7bcbe95 bellard
                    else if (dp && (insn & 1))
3333 b7bcbe95 bellard
                        offset = 4;
3334 b7bcbe95 bellard
                    else
3335 b7bcbe95 bellard
                        offset = 0;
3336 b7bcbe95 bellard
3337 b7bcbe95 bellard
                    if (offset != 0)
3338 312eea9f Filip Navara
                        tcg_gen_addi_i32(addr, addr, offset);
3339 312eea9f Filip Navara
                    store_reg(s, rn, addr);
3340 312eea9f Filip Navara
                } else {
3341 312eea9f Filip Navara
                    dead_tmp(addr);
3342 b7bcbe95 bellard
                }
3343 b7bcbe95 bellard
            }
3344 b7bcbe95 bellard
        }
3345 b7bcbe95 bellard
        break;
3346 b7bcbe95 bellard
    default:
3347 b7bcbe95 bellard
        /* Should never happen.  */
3348 b7bcbe95 bellard
        return 1;
3349 b7bcbe95 bellard
    }
3350 b7bcbe95 bellard
    return 0;
3351 b7bcbe95 bellard
}
3352 b7bcbe95 bellard
3353 6e256c93 bellard
static inline void gen_goto_tb(DisasContext *s, int n, uint32_t dest)
3354 c53be334 bellard
{
3355 6e256c93 bellard
    TranslationBlock *tb;
3356 6e256c93 bellard
3357 6e256c93 bellard
    tb = s->tb;
3358 6e256c93 bellard
    if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK)) {
3359 57fec1fe bellard
        tcg_gen_goto_tb(n);
3360 8984bd2e pbrook
        gen_set_pc_im(dest);
3361 57fec1fe bellard
        tcg_gen_exit_tb((long)tb + n);
3362 6e256c93 bellard
    } else {
3363 8984bd2e pbrook
        gen_set_pc_im(dest);
3364 57fec1fe bellard
        tcg_gen_exit_tb(0);
3365 6e256c93 bellard
    }
3366 c53be334 bellard
}
3367 c53be334 bellard
3368 8aaca4c0 bellard
static inline void gen_jmp (DisasContext *s, uint32_t dest)
3369 8aaca4c0 bellard
{
3370 551bd27f ths
    if (unlikely(s->singlestep_enabled)) {
3371 8aaca4c0 bellard
        /* An indirect jump so that we still trigger the debug exception.  */
3372 5899f386 bellard
        if (s->thumb)
3373 d9ba4830 pbrook
            dest |= 1;
3374 d9ba4830 pbrook
        gen_bx_im(s, dest);
3375 8aaca4c0 bellard
    } else {
3376 6e256c93 bellard
        gen_goto_tb(s, 0, dest);
3377 8aaca4c0 bellard
        s->is_jmp = DISAS_TB_JUMP;
3378 8aaca4c0 bellard
    }
3379 8aaca4c0 bellard
}
3380 8aaca4c0 bellard
3381 d9ba4830 pbrook
static inline void gen_mulxy(TCGv t0, TCGv t1, int x, int y)
3382 b5ff1b31 bellard
{
3383 ee097184 bellard
    if (x)
3384 d9ba4830 pbrook
        tcg_gen_sari_i32(t0, t0, 16);
3385 b5ff1b31 bellard
    else
3386 d9ba4830 pbrook
        gen_sxth(t0);
3387 ee097184 bellard
    if (y)
3388 d9ba4830 pbrook
        tcg_gen_sari_i32(t1, t1, 16);
3389 b5ff1b31 bellard
    else
3390 d9ba4830 pbrook
        gen_sxth(t1);
3391 d9ba4830 pbrook
    tcg_gen_mul_i32(t0, t0, t1);
3392 b5ff1b31 bellard
}
3393 b5ff1b31 bellard
3394 b5ff1b31 bellard
/* Return the mask of PSR bits set by a MSR instruction.  */
3395 9ee6e8bb pbrook
static uint32_t msr_mask(CPUState *env, DisasContext *s, int flags, int spsr) {
3396 b5ff1b31 bellard
    uint32_t mask;
3397 b5ff1b31 bellard
3398 b5ff1b31 bellard
    mask = 0;
3399 b5ff1b31 bellard
    if (flags & (1 << 0))
3400 b5ff1b31 bellard
        mask |= 0xff;
3401 b5ff1b31 bellard
    if (flags & (1 << 1))
3402 b5ff1b31 bellard
        mask |= 0xff00;
3403 b5ff1b31 bellard
    if (flags & (1 << 2))
3404 b5ff1b31 bellard
        mask |= 0xff0000;
3405 b5ff1b31 bellard
    if (flags & (1 << 3))
3406 b5ff1b31 bellard
        mask |= 0xff000000;
3407 9ee6e8bb pbrook
3408 2ae23e75 pbrook
    /* Mask out undefined bits.  */
3409 9ee6e8bb pbrook
    mask &= ~CPSR_RESERVED;
3410 9ee6e8bb pbrook
    if (!arm_feature(env, ARM_FEATURE_V6))
3411 e160c51c pbrook
        mask &= ~(CPSR_E | CPSR_GE);
3412 9ee6e8bb pbrook
    if (!arm_feature(env, ARM_FEATURE_THUMB2))
3413 e160c51c pbrook
        mask &= ~CPSR_IT;
3414 9ee6e8bb pbrook
    /* Mask out execution state bits.  */
3415 2ae23e75 pbrook
    if (!spsr)
3416 e160c51c pbrook
        mask &= ~CPSR_EXEC;
3417 b5ff1b31 bellard
    /* Mask out privileged bits.  */
3418 b5ff1b31 bellard
    if (IS_USER(s))
3419 9ee6e8bb pbrook
        mask &= CPSR_USER;
3420 b5ff1b31 bellard
    return mask;
3421 b5ff1b31 bellard
}
3422 b5ff1b31 bellard
3423 2fbac54b Filip Navara
/* Returns nonzero if access to the PSR is not permitted. Marks t0 as dead. */
3424 2fbac54b Filip Navara
static int gen_set_psr(DisasContext *s, uint32_t mask, int spsr, TCGv t0)
3425 b5ff1b31 bellard
{
3426 d9ba4830 pbrook
    TCGv tmp;
3427 b5ff1b31 bellard
    if (spsr) {
3428 b5ff1b31 bellard
        /* ??? This is also undefined in system mode.  */
3429 b5ff1b31 bellard
        if (IS_USER(s))
3430 b5ff1b31 bellard
            return 1;
3431 d9ba4830 pbrook
3432 d9ba4830 pbrook
        tmp = load_cpu_field(spsr);
3433 d9ba4830 pbrook
        tcg_gen_andi_i32(tmp, tmp, ~mask);
3434 2fbac54b Filip Navara
        tcg_gen_andi_i32(t0, t0, mask);
3435 2fbac54b Filip Navara
        tcg_gen_or_i32(tmp, tmp, t0);
3436 d9ba4830 pbrook
        store_cpu_field(tmp, spsr);
3437 b5ff1b31 bellard
    } else {
3438 2fbac54b Filip Navara
        gen_set_cpsr(t0, mask);
3439 b5ff1b31 bellard
    }
3440 2fbac54b Filip Navara
    dead_tmp(t0);
3441 b5ff1b31 bellard
    gen_lookup_tb(s);
3442 b5ff1b31 bellard
    return 0;
3443 b5ff1b31 bellard
}
3444 b5ff1b31 bellard
3445 2fbac54b Filip Navara
/* Returns nonzero if access to the PSR is not permitted.  */
3446 2fbac54b Filip Navara
static int gen_set_psr_im(DisasContext *s, uint32_t mask, int spsr, uint32_t val)
3447 2fbac54b Filip Navara
{
3448 2fbac54b Filip Navara
    TCGv tmp;
3449 2fbac54b Filip Navara
    tmp = new_tmp();
3450 2fbac54b Filip Navara
    tcg_gen_movi_i32(tmp, val);
3451 2fbac54b Filip Navara
    return gen_set_psr(s, mask, spsr, tmp);
3452 2fbac54b Filip Navara
}
3453 2fbac54b Filip Navara
3454 e9bb4aa9 Juha Riihimรคki
/* Generate an old-style exception return. Marks pc as dead. */
3455 e9bb4aa9 Juha Riihimรคki
static void gen_exception_return(DisasContext *s, TCGv pc)
3456 b5ff1b31 bellard
{
3457 d9ba4830 pbrook
    TCGv tmp;
3458 e9bb4aa9 Juha Riihimรคki
    store_reg(s, 15, pc);
3459 d9ba4830 pbrook
    tmp = load_cpu_field(spsr);
3460 d9ba4830 pbrook
    gen_set_cpsr(tmp, 0xffffffff);
3461 d9ba4830 pbrook
    dead_tmp(tmp);
3462 b5ff1b31 bellard
    s->is_jmp = DISAS_UPDATE;
3463 b5ff1b31 bellard
}
3464 b5ff1b31 bellard
3465 b0109805 pbrook
/* Generate a v6 exception return.  Marks both values as dead.  */
3466 b0109805 pbrook
static void gen_rfe(DisasContext *s, TCGv pc, TCGv cpsr)
3467 2c0262af bellard
{
3468 b0109805 pbrook
    gen_set_cpsr(cpsr, 0xffffffff);
3469 b0109805 pbrook
    dead_tmp(cpsr);
3470 b0109805 pbrook
    store_reg(s, 15, pc);
3471 9ee6e8bb pbrook
    s->is_jmp = DISAS_UPDATE;
3472 9ee6e8bb pbrook
}
3473 3b46e624 ths
3474 9ee6e8bb pbrook
static inline void
3475 9ee6e8bb pbrook
gen_set_condexec (DisasContext *s)
3476 9ee6e8bb pbrook
{
3477 9ee6e8bb pbrook
    if (s->condexec_mask) {
3478 8f01245e pbrook
        uint32_t val = (s->condexec_cond << 4) | (s->condexec_mask >> 1);
3479 8f01245e pbrook
        TCGv tmp = new_tmp();
3480 8f01245e pbrook
        tcg_gen_movi_i32(tmp, val);
3481 d9ba4830 pbrook
        store_cpu_field(tmp, condexec_bits);
3482 9ee6e8bb pbrook
    }
3483 9ee6e8bb pbrook
}
3484 3b46e624 ths
3485 9ee6e8bb pbrook
static void gen_nop_hint(DisasContext *s, int val)
3486 9ee6e8bb pbrook
{
3487 9ee6e8bb pbrook
    switch (val) {
3488 9ee6e8bb pbrook
    case 3: /* wfi */
3489 8984bd2e pbrook
        gen_set_pc_im(s->pc);
3490 9ee6e8bb pbrook
        s->is_jmp = DISAS_WFI;
3491 9ee6e8bb pbrook
        break;
3492 9ee6e8bb pbrook
    case 2: /* wfe */
3493 9ee6e8bb pbrook
    case 4: /* sev */
3494 9ee6e8bb pbrook
        /* TODO: Implement SEV and WFE.  May help SMP performance.  */
3495 9ee6e8bb pbrook
    default: /* nop */
3496 9ee6e8bb pbrook
        break;
3497 9ee6e8bb pbrook
    }
3498 9ee6e8bb pbrook
}
3499 99c475ab bellard
3500 ad69471c pbrook
#define CPU_V001 cpu_V0, cpu_V0, cpu_V1
3501 9ee6e8bb pbrook
3502 dd8fbd78 Filip Navara
static inline int gen_neon_add(int size, TCGv t0, TCGv t1)
3503 9ee6e8bb pbrook
{
3504 9ee6e8bb pbrook
    switch (size) {
3505 dd8fbd78 Filip Navara
    case 0: gen_helper_neon_add_u8(t0, t0, t1); break;
3506 dd8fbd78 Filip Navara
    case 1: gen_helper_neon_add_u16(t0, t0, t1); break;
3507 dd8fbd78 Filip Navara
    case 2: tcg_gen_add_i32(t0, t0, t1); break;
3508 9ee6e8bb pbrook
    default: return 1;
3509 9ee6e8bb pbrook
    }
3510 9ee6e8bb pbrook
    return 0;
3511 9ee6e8bb pbrook
}
3512 9ee6e8bb pbrook
3513 dd8fbd78 Filip Navara
static inline void gen_neon_rsb(int size, TCGv t0, TCGv t1)
3514 ad69471c pbrook
{
3515 ad69471c pbrook
    switch (size) {
3516 dd8fbd78 Filip Navara
    case 0: gen_helper_neon_sub_u8(t0, t1, t0); break;
3517 dd8fbd78 Filip Navara
    case 1: gen_helper_neon_sub_u16(t0, t1, t0); break;
3518 dd8fbd78 Filip Navara
    case 2: tcg_gen_sub_i32(t0, t1, t0); break;
3519 ad69471c pbrook
    default: return;
3520 ad69471c pbrook
    }
3521 ad69471c pbrook
}
3522 ad69471c pbrook
3523 ad69471c pbrook
/* 32-bit pairwise ops end up the same as the elementwise versions.  */
3524 ad69471c pbrook
#define gen_helper_neon_pmax_s32  gen_helper_neon_max_s32
3525 ad69471c pbrook
#define gen_helper_neon_pmax_u32  gen_helper_neon_max_u32
3526 ad69471c pbrook
#define gen_helper_neon_pmin_s32  gen_helper_neon_min_s32
3527 ad69471c pbrook
#define gen_helper_neon_pmin_u32  gen_helper_neon_min_u32
3528 ad69471c pbrook
3529 ad69471c pbrook
/* FIXME: This is wrong.  They set the wrong overflow bit.  */
3530 ad69471c pbrook
#define gen_helper_neon_qadd_s32(a, e, b, c) gen_helper_add_saturate(a, b, c)
3531 ad69471c pbrook
#define gen_helper_neon_qadd_u32(a, e, b, c) gen_helper_add_usaturate(a, b, c)
3532 ad69471c pbrook
#define gen_helper_neon_qsub_s32(a, e, b, c) gen_helper_sub_saturate(a, b, c)
3533 ad69471c pbrook
#define gen_helper_neon_qsub_u32(a, e, b, c) gen_helper_sub_usaturate(a, b, c)
3534 ad69471c pbrook
3535 ad69471c pbrook
#define GEN_NEON_INTEGER_OP_ENV(name) do { \
3536 ad69471c pbrook
    switch ((size << 1) | u) { \
3537 ad69471c pbrook
    case 0: \
3538 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s8(tmp, cpu_env, tmp, tmp2); \
3539 ad69471c pbrook
        break; \
3540 ad69471c pbrook
    case 1: \
3541 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u8(tmp, cpu_env, tmp, tmp2); \
3542 ad69471c pbrook
        break; \
3543 ad69471c pbrook
    case 2: \
3544 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s16(tmp, cpu_env, tmp, tmp2); \
3545 ad69471c pbrook
        break; \
3546 ad69471c pbrook
    case 3: \
3547 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u16(tmp, cpu_env, tmp, tmp2); \
3548 ad69471c pbrook
        break; \
3549 ad69471c pbrook
    case 4: \
3550 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s32(tmp, cpu_env, tmp, tmp2); \
3551 ad69471c pbrook
        break; \
3552 ad69471c pbrook
    case 5: \
3553 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u32(tmp, cpu_env, tmp, tmp2); \
3554 ad69471c pbrook
        break; \
3555 ad69471c pbrook
    default: return 1; \
3556 ad69471c pbrook
    }} while (0)
3557 9ee6e8bb pbrook
3558 9ee6e8bb pbrook
#define GEN_NEON_INTEGER_OP(name) do { \
3559 9ee6e8bb pbrook
    switch ((size << 1) | u) { \
3560 ad69471c pbrook
    case 0: \
3561 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s8(tmp, tmp, tmp2); \
3562 ad69471c pbrook
        break; \
3563 ad69471c pbrook
    case 1: \
3564 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u8(tmp, tmp, tmp2); \
3565 ad69471c pbrook
        break; \
3566 ad69471c pbrook
    case 2: \
3567 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s16(tmp, tmp, tmp2); \
3568 ad69471c pbrook
        break; \
3569 ad69471c pbrook
    case 3: \
3570 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u16(tmp, tmp, tmp2); \
3571 ad69471c pbrook
        break; \
3572 ad69471c pbrook
    case 4: \
3573 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_s32(tmp, tmp, tmp2); \
3574 ad69471c pbrook
        break; \
3575 ad69471c pbrook
    case 5: \
3576 dd8fbd78 Filip Navara
        gen_helper_neon_##name##_u32(tmp, tmp, tmp2); \
3577 ad69471c pbrook
        break; \
3578 9ee6e8bb pbrook
    default: return 1; \
3579 9ee6e8bb pbrook
    }} while (0)
3580 9ee6e8bb pbrook
3581 dd8fbd78 Filip Navara
static TCGv neon_load_scratch(int scratch)
3582 9ee6e8bb pbrook
{
3583 dd8fbd78 Filip Navara
    TCGv tmp = new_tmp();
3584 dd8fbd78 Filip Navara
    tcg_gen_ld_i32(tmp, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
3585 dd8fbd78 Filip Navara
    return tmp;
3586 9ee6e8bb pbrook
}
3587 9ee6e8bb pbrook
3588 dd8fbd78 Filip Navara
static void neon_store_scratch(int scratch, TCGv var)
3589 9ee6e8bb pbrook
{
3590 dd8fbd78 Filip Navara
    tcg_gen_st_i32(var, cpu_env, offsetof(CPUARMState, vfp.scratch[scratch]));
3591 dd8fbd78 Filip Navara
    dead_tmp(var);
3592 9ee6e8bb pbrook
}
3593 9ee6e8bb pbrook
3594 dd8fbd78 Filip Navara
static inline TCGv neon_get_scalar(int size, int reg)
3595 9ee6e8bb pbrook
{
3596 dd8fbd78 Filip Navara
    TCGv tmp;
3597 9ee6e8bb pbrook
    if (size == 1) {
3598 dd8fbd78 Filip Navara
        tmp = neon_load_reg(reg >> 1, reg & 1);
3599 9ee6e8bb pbrook
    } else {
3600 dd8fbd78 Filip Navara
        tmp = neon_load_reg(reg >> 2, (reg >> 1) & 1);
3601 dd8fbd78 Filip Navara
        if (reg & 1) {
3602 dd8fbd78 Filip Navara
            gen_neon_dup_low16(tmp);
3603 dd8fbd78 Filip Navara
        } else {
3604 dd8fbd78 Filip Navara
            gen_neon_dup_high16(tmp);
3605 dd8fbd78 Filip Navara
        }
3606 9ee6e8bb pbrook
    }
3607 dd8fbd78 Filip Navara
    return tmp;
3608 9ee6e8bb pbrook
}
3609 9ee6e8bb pbrook
3610 19457615 Filip Navara
static void gen_neon_unzip_u8(TCGv t0, TCGv t1)
3611 19457615 Filip Navara
{
3612 19457615 Filip Navara
    TCGv rd, rm, tmp;
3613 19457615 Filip Navara
3614 19457615 Filip Navara
    rd = new_tmp();
3615 19457615 Filip Navara
    rm = new_tmp();
3616 19457615 Filip Navara
    tmp = new_tmp();
3617 19457615 Filip Navara
3618 19457615 Filip Navara
    tcg_gen_andi_i32(rd, t0, 0xff);
3619 19457615 Filip Navara
    tcg_gen_shri_i32(tmp, t0, 8);
3620 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
3621 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3622 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t1, 16);
3623 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
3624 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3625 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t1, 8);
3626 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff000000);
3627 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3628 19457615 Filip Navara
3629 19457615 Filip Navara
    tcg_gen_shri_i32(rm, t0, 8);
3630 19457615 Filip Navara
    tcg_gen_andi_i32(rm, rm, 0xff);
3631 19457615 Filip Navara
    tcg_gen_shri_i32(tmp, t0, 16);
3632 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
3633 19457615 Filip Navara
    tcg_gen_or_i32(rm, rm, tmp);
3634 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t1, 8);
3635 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
3636 19457615 Filip Navara
    tcg_gen_or_i32(rm, rm, tmp);
3637 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t1, 0xff000000);
3638 19457615 Filip Navara
    tcg_gen_or_i32(t1, rm, tmp);
3639 19457615 Filip Navara
    tcg_gen_mov_i32(t0, rd);
3640 19457615 Filip Navara
3641 19457615 Filip Navara
    dead_tmp(tmp);
3642 19457615 Filip Navara
    dead_tmp(rm);
3643 19457615 Filip Navara
    dead_tmp(rd);
3644 19457615 Filip Navara
}
3645 19457615 Filip Navara
3646 19457615 Filip Navara
static void gen_neon_zip_u8(TCGv t0, TCGv t1)
3647 19457615 Filip Navara
{
3648 19457615 Filip Navara
    TCGv rd, rm, tmp;
3649 19457615 Filip Navara
3650 19457615 Filip Navara
    rd = new_tmp();
3651 19457615 Filip Navara
    rm = new_tmp();
3652 19457615 Filip Navara
    tmp = new_tmp();
3653 19457615 Filip Navara
3654 19457615 Filip Navara
    tcg_gen_andi_i32(rd, t0, 0xff);
3655 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t1, 8);
3656 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
3657 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3658 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t0, 16);
3659 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
3660 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3661 19457615 Filip Navara
    tcg_gen_shli_i32(tmp, t1, 24);
3662 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff000000);
3663 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3664 19457615 Filip Navara
3665 19457615 Filip Navara
    tcg_gen_andi_i32(rm, t1, 0xff000000);
3666 19457615 Filip Navara
    tcg_gen_shri_i32(tmp, t0, 8);
3667 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff0000);
3668 19457615 Filip Navara
    tcg_gen_or_i32(rm, rm, tmp);
3669 19457615 Filip Navara
    tcg_gen_shri_i32(tmp, t1, 8);
3670 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff00);
3671 19457615 Filip Navara
    tcg_gen_or_i32(rm, rm, tmp);
3672 19457615 Filip Navara
    tcg_gen_shri_i32(tmp, t0, 16);
3673 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, tmp, 0xff);
3674 19457615 Filip Navara
    tcg_gen_or_i32(t1, rm, tmp);
3675 19457615 Filip Navara
    tcg_gen_mov_i32(t0, rd);
3676 19457615 Filip Navara
3677 19457615 Filip Navara
    dead_tmp(tmp);
3678 19457615 Filip Navara
    dead_tmp(rm);
3679 19457615 Filip Navara
    dead_tmp(rd);
3680 19457615 Filip Navara
}
3681 19457615 Filip Navara
3682 19457615 Filip Navara
static void gen_neon_zip_u16(TCGv t0, TCGv t1)
3683 19457615 Filip Navara
{
3684 19457615 Filip Navara
    TCGv tmp, tmp2;
3685 19457615 Filip Navara
3686 19457615 Filip Navara
    tmp = new_tmp();
3687 19457615 Filip Navara
    tmp2 = new_tmp();
3688 19457615 Filip Navara
3689 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t0, 0xffff);
3690 19457615 Filip Navara
    tcg_gen_shli_i32(tmp2, t1, 16);
3691 19457615 Filip Navara
    tcg_gen_or_i32(tmp, tmp, tmp2);
3692 19457615 Filip Navara
    tcg_gen_andi_i32(t1, t1, 0xffff0000);
3693 19457615 Filip Navara
    tcg_gen_shri_i32(tmp2, t0, 16);
3694 19457615 Filip Navara
    tcg_gen_or_i32(t1, t1, tmp2);
3695 19457615 Filip Navara
    tcg_gen_mov_i32(t0, tmp);
3696 19457615 Filip Navara
3697 19457615 Filip Navara
    dead_tmp(tmp2);
3698 19457615 Filip Navara
    dead_tmp(tmp);
3699 19457615 Filip Navara
}
3700 19457615 Filip Navara
3701 9ee6e8bb pbrook
static void gen_neon_unzip(int reg, int q, int tmp, int size)
3702 9ee6e8bb pbrook
{
3703 9ee6e8bb pbrook
    int n;
3704 dd8fbd78 Filip Navara
    TCGv t0, t1;
3705 9ee6e8bb pbrook
3706 9ee6e8bb pbrook
    for (n = 0; n < q + 1; n += 2) {
3707 dd8fbd78 Filip Navara
        t0 = neon_load_reg(reg, n);
3708 dd8fbd78 Filip Navara
        t1 = neon_load_reg(reg, n + 1);
3709 9ee6e8bb pbrook
        switch (size) {
3710 dd8fbd78 Filip Navara
        case 0: gen_neon_unzip_u8(t0, t1); break;
3711 dd8fbd78 Filip Navara
        case 1: gen_neon_zip_u16(t0, t1); break; /* zip and unzip are the same.  */
3712 9ee6e8bb pbrook
        case 2: /* no-op */; break;
3713 9ee6e8bb pbrook
        default: abort();
3714 9ee6e8bb pbrook
        }
3715 dd8fbd78 Filip Navara
        neon_store_scratch(tmp + n, t0);
3716 dd8fbd78 Filip Navara
        neon_store_scratch(tmp + n + 1, t1);
3717 9ee6e8bb pbrook
    }
3718 9ee6e8bb pbrook
}
3719 9ee6e8bb pbrook
3720 19457615 Filip Navara
static void gen_neon_trn_u8(TCGv t0, TCGv t1)
3721 19457615 Filip Navara
{
3722 19457615 Filip Navara
    TCGv rd, tmp;
3723 19457615 Filip Navara
3724 19457615 Filip Navara
    rd = new_tmp();
3725 19457615 Filip Navara
    tmp = new_tmp();
3726 19457615 Filip Navara
3727 19457615 Filip Navara
    tcg_gen_shli_i32(rd, t0, 8);
3728 19457615 Filip Navara
    tcg_gen_andi_i32(rd, rd, 0xff00ff00);
3729 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t1, 0x00ff00ff);
3730 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3731 19457615 Filip Navara
3732 19457615 Filip Navara
    tcg_gen_shri_i32(t1, t1, 8);
3733 19457615 Filip Navara
    tcg_gen_andi_i32(t1, t1, 0x00ff00ff);
3734 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t0, 0xff00ff00);
3735 19457615 Filip Navara
    tcg_gen_or_i32(t1, t1, tmp);
3736 19457615 Filip Navara
    tcg_gen_mov_i32(t0, rd);
3737 19457615 Filip Navara
3738 19457615 Filip Navara
    dead_tmp(tmp);
3739 19457615 Filip Navara
    dead_tmp(rd);
3740 19457615 Filip Navara
}
3741 19457615 Filip Navara
3742 19457615 Filip Navara
static void gen_neon_trn_u16(TCGv t0, TCGv t1)
3743 19457615 Filip Navara
{
3744 19457615 Filip Navara
    TCGv rd, tmp;
3745 19457615 Filip Navara
3746 19457615 Filip Navara
    rd = new_tmp();
3747 19457615 Filip Navara
    tmp = new_tmp();
3748 19457615 Filip Navara
3749 19457615 Filip Navara
    tcg_gen_shli_i32(rd, t0, 16);
3750 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t1, 0xffff);
3751 19457615 Filip Navara
    tcg_gen_or_i32(rd, rd, tmp);
3752 19457615 Filip Navara
    tcg_gen_shri_i32(t1, t1, 16);
3753 19457615 Filip Navara
    tcg_gen_andi_i32(tmp, t0, 0xffff0000);
3754 19457615 Filip Navara
    tcg_gen_or_i32(t1, t1, tmp);
3755 19457615 Filip Navara
    tcg_gen_mov_i32(t0, rd);
3756 19457615 Filip Navara
3757 19457615 Filip Navara
    dead_tmp(tmp);
3758 19457615 Filip Navara
    dead_tmp(rd);
3759 19457615 Filip Navara
}
3760 19457615 Filip Navara
3761 19457615 Filip Navara
3762 9ee6e8bb pbrook
static struct {
3763 9ee6e8bb pbrook
    int nregs;
3764 9ee6e8bb pbrook
    int interleave;
3765 9ee6e8bb pbrook
    int spacing;
3766 9ee6e8bb pbrook
} neon_ls_element_type[11] = {
3767 9ee6e8bb pbrook
    {4, 4, 1},
3768 9ee6e8bb pbrook
    {4, 4, 2},
3769 9ee6e8bb pbrook
    {4, 1, 1},
3770 9ee6e8bb pbrook
    {4, 2, 1},
3771 9ee6e8bb pbrook
    {3, 3, 1},
3772 9ee6e8bb pbrook
    {3, 3, 2},
3773 9ee6e8bb pbrook
    {3, 1, 1},
3774 9ee6e8bb pbrook
    {1, 1, 1},
3775 9ee6e8bb pbrook
    {2, 2, 1},
3776 9ee6e8bb pbrook
    {2, 2, 2},
3777 9ee6e8bb pbrook
    {2, 1, 1}
3778 9ee6e8bb pbrook
};
3779 9ee6e8bb pbrook
3780 9ee6e8bb pbrook
/* Translate a NEON load/store element instruction.  Return nonzero if the
3781 9ee6e8bb pbrook
   instruction is invalid.  */
3782 9ee6e8bb pbrook
static int disas_neon_ls_insn(CPUState * env, DisasContext *s, uint32_t insn)
3783 9ee6e8bb pbrook
{
3784 9ee6e8bb pbrook
    int rd, rn, rm;
3785 9ee6e8bb pbrook
    int op;
3786 9ee6e8bb pbrook
    int nregs;
3787 9ee6e8bb pbrook
    int interleave;
3788 84496233 Juha Riihimรคki
    int spacing;
3789 9ee6e8bb pbrook
    int stride;
3790 9ee6e8bb pbrook
    int size;
3791 9ee6e8bb pbrook
    int reg;
3792 9ee6e8bb pbrook
    int pass;
3793 9ee6e8bb pbrook
    int load;
3794 9ee6e8bb pbrook
    int shift;
3795 9ee6e8bb pbrook
    int n;
3796 1b2b1e54 Filip Navara
    TCGv addr;
3797 b0109805 pbrook
    TCGv tmp;
3798 8f8e3aa4 pbrook
    TCGv tmp2;
3799 84496233 Juha Riihimรคki
    TCGv_i64 tmp64;
3800 9ee6e8bb pbrook
3801 9ee6e8bb pbrook
    if (!vfp_enabled(env))
3802 9ee6e8bb pbrook
      return 1;
3803 9ee6e8bb pbrook
    VFP_DREG_D(rd, insn);
3804 9ee6e8bb pbrook
    rn = (insn >> 16) & 0xf;
3805 9ee6e8bb pbrook
    rm = insn & 0xf;
3806 9ee6e8bb pbrook
    load = (insn & (1 << 21)) != 0;
3807 1b2b1e54 Filip Navara
    addr = new_tmp();
3808 9ee6e8bb pbrook
    if ((insn & (1 << 23)) == 0) {
3809 9ee6e8bb pbrook
        /* Load store all elements.  */
3810 9ee6e8bb pbrook
        op = (insn >> 8) & 0xf;
3811 9ee6e8bb pbrook
        size = (insn >> 6) & 3;
3812 84496233 Juha Riihimรคki
        if (op > 10)
3813 9ee6e8bb pbrook
            return 1;
3814 9ee6e8bb pbrook
        nregs = neon_ls_element_type[op].nregs;
3815 9ee6e8bb pbrook
        interleave = neon_ls_element_type[op].interleave;
3816 84496233 Juha Riihimรคki
        spacing = neon_ls_element_type[op].spacing;
3817 84496233 Juha Riihimรคki
        if (size == 3 && (interleave | spacing) != 1)
3818 84496233 Juha Riihimรคki
            return 1;
3819 dcc65026 Aurelien Jarno
        load_reg_var(s, addr, rn);
3820 9ee6e8bb pbrook
        stride = (1 << size) * interleave;
3821 9ee6e8bb pbrook
        for (reg = 0; reg < nregs; reg++) {
3822 9ee6e8bb pbrook
            if (interleave > 2 || (interleave == 2 && nregs == 2)) {
3823 dcc65026 Aurelien Jarno
                load_reg_var(s, addr, rn);
3824 dcc65026 Aurelien Jarno
                tcg_gen_addi_i32(addr, addr, (1 << size) * reg);
3825 9ee6e8bb pbrook
            } else if (interleave == 2 && nregs == 4 && reg == 2) {
3826 dcc65026 Aurelien Jarno
                load_reg_var(s, addr, rn);
3827 dcc65026 Aurelien Jarno
                tcg_gen_addi_i32(addr, addr, 1 << size);
3828 9ee6e8bb pbrook
            }
3829 84496233 Juha Riihimรคki
            if (size == 3) {
3830 84496233 Juha Riihimรคki
                if (load) {
3831 84496233 Juha Riihimรคki
                    tmp64 = gen_ld64(addr, IS_USER(s));
3832 84496233 Juha Riihimรคki
                    neon_store_reg64(tmp64, rd);
3833 84496233 Juha Riihimรคki
                    tcg_temp_free_i64(tmp64);
3834 84496233 Juha Riihimรคki
                } else {
3835 84496233 Juha Riihimรคki
                    tmp64 = tcg_temp_new_i64();
3836 84496233 Juha Riihimรคki
                    neon_load_reg64(tmp64, rd);
3837 84496233 Juha Riihimรคki
                    gen_st64(tmp64, addr, IS_USER(s));
3838 84496233 Juha Riihimรคki
                }
3839 84496233 Juha Riihimรคki
                tcg_gen_addi_i32(addr, addr, stride);
3840 84496233 Juha Riihimรคki
            } else {
3841 84496233 Juha Riihimรคki
                for (pass = 0; pass < 2; pass++) {
3842 84496233 Juha Riihimรคki
                    if (size == 2) {
3843 84496233 Juha Riihimรคki
                        if (load) {
3844 84496233 Juha Riihimรคki
                            tmp = gen_ld32(addr, IS_USER(s));
3845 84496233 Juha Riihimรคki
                            neon_store_reg(rd, pass, tmp);
3846 84496233 Juha Riihimรคki
                        } else {
3847 84496233 Juha Riihimรคki
                            tmp = neon_load_reg(rd, pass);
3848 84496233 Juha Riihimรคki
                            gen_st32(tmp, addr, IS_USER(s));
3849 84496233 Juha Riihimรคki
                        }
3850 1b2b1e54 Filip Navara
                        tcg_gen_addi_i32(addr, addr, stride);
3851 84496233 Juha Riihimรคki
                    } else if (size == 1) {
3852 84496233 Juha Riihimรคki
                        if (load) {
3853 84496233 Juha Riihimรคki
                            tmp = gen_ld16u(addr, IS_USER(s));
3854 84496233 Juha Riihimรคki
                            tcg_gen_addi_i32(addr, addr, stride);
3855 84496233 Juha Riihimรคki
                            tmp2 = gen_ld16u(addr, IS_USER(s));
3856 84496233 Juha Riihimรคki
                            tcg_gen_addi_i32(addr, addr, stride);
3857 84496233 Juha Riihimรคki
                            gen_bfi(tmp, tmp, tmp2, 16, 0xffff);
3858 84496233 Juha Riihimรคki
                            dead_tmp(tmp2);
3859 84496233 Juha Riihimรคki
                            neon_store_reg(rd, pass, tmp);
3860 84496233 Juha Riihimรคki
                        } else {
3861 84496233 Juha Riihimรคki
                            tmp = neon_load_reg(rd, pass);
3862 84496233 Juha Riihimรคki
                            tmp2 = new_tmp();
3863 84496233 Juha Riihimรคki
                            tcg_gen_shri_i32(tmp2, tmp, 16);
3864 84496233 Juha Riihimรคki
                            gen_st16(tmp, addr, IS_USER(s));
3865 84496233 Juha Riihimรคki
                            tcg_gen_addi_i32(addr, addr, stride);
3866 84496233 Juha Riihimรคki
                            gen_st16(tmp2, addr, IS_USER(s));
3867 1b2b1e54 Filip Navara
                            tcg_gen_addi_i32(addr, addr, stride);
3868 9ee6e8bb pbrook
                        }
3869 84496233 Juha Riihimรคki
                    } else /* size == 0 */ {
3870 84496233 Juha Riihimรคki
                        if (load) {
3871 84496233 Juha Riihimรคki
                            TCGV_UNUSED(tmp2);
3872 84496233 Juha Riihimรคki
                            for (n = 0; n < 4; n++) {
3873 84496233 Juha Riihimรคki
                                tmp = gen_ld8u(addr, IS_USER(s));
3874 84496233 Juha Riihimรคki
                                tcg_gen_addi_i32(addr, addr, stride);
3875 84496233 Juha Riihimรคki
                                if (n == 0) {
3876 84496233 Juha Riihimรคki
                                    tmp2 = tmp;
3877 84496233 Juha Riihimรคki
                                } else {
3878 84496233 Juha Riihimรคki
                                    gen_bfi(tmp2, tmp2, tmp, n * 8, 0xff);
3879 84496233 Juha Riihimรคki
                                    dead_tmp(tmp);
3880 84496233 Juha Riihimรคki
                                }
3881 9ee6e8bb pbrook
                            }
3882 84496233 Juha Riihimรคki
                            neon_store_reg(rd, pass, tmp2);
3883 84496233 Juha Riihimรคki
                        } else {
3884 84496233 Juha Riihimรคki
                            tmp2 = neon_load_reg(rd, pass);
3885 84496233 Juha Riihimรคki
                            for (n = 0; n < 4; n++) {
3886 84496233 Juha Riihimรคki
                                tmp = new_tmp();
3887 84496233 Juha Riihimรคki
                                if (n == 0) {
3888 84496233 Juha Riihimรคki
                                    tcg_gen_mov_i32(tmp, tmp2);
3889 84496233 Juha Riihimรคki
                                } else {
3890 84496233 Juha Riihimรคki
                                    tcg_gen_shri_i32(tmp, tmp2, n * 8);
3891 84496233 Juha Riihimรคki
                                }
3892 84496233 Juha Riihimรคki
                                gen_st8(tmp, addr, IS_USER(s));
3893 84496233 Juha Riihimรคki
                                tcg_gen_addi_i32(addr, addr, stride);
3894 84496233 Juha Riihimรคki
                            }
3895 84496233 Juha Riihimรคki
                            dead_tmp(tmp2);
3896 9ee6e8bb pbrook
                        }
3897 9ee6e8bb pbrook
                    }
3898 9ee6e8bb pbrook
                }
3899 9ee6e8bb pbrook
            }
3900 84496233 Juha Riihimรคki
            rd += spacing;
3901 9ee6e8bb pbrook
        }
3902 9ee6e8bb pbrook
        stride = nregs * 8;
3903 9ee6e8bb pbrook
    } else {
3904 9ee6e8bb pbrook
        size = (insn >> 10) & 3;
3905 9ee6e8bb pbrook
        if (size == 3) {
3906 9ee6e8bb pbrook
            /* Load single element to all lanes.  */
3907 9ee6e8bb pbrook
            if (!load)
3908 9ee6e8bb pbrook
                return 1;
3909 9ee6e8bb pbrook
            size = (insn >> 6) & 3;
3910 9ee6e8bb pbrook
            nregs = ((insn >> 8) & 3) + 1;
3911 9ee6e8bb pbrook
            stride = (insn & (1 << 5)) ? 2 : 1;
3912 dcc65026 Aurelien Jarno
            load_reg_var(s, addr, rn);
3913 9ee6e8bb pbrook
            for (reg = 0; reg < nregs; reg++) {
3914 9ee6e8bb pbrook
                switch (size) {
3915 9ee6e8bb pbrook
                case 0:
3916 1b2b1e54 Filip Navara
                    tmp = gen_ld8u(addr, IS_USER(s));
3917 ad69471c pbrook
                    gen_neon_dup_u8(tmp, 0);
3918 9ee6e8bb pbrook
                    break;
3919 9ee6e8bb pbrook
                case 1:
3920 1b2b1e54 Filip Navara
                    tmp = gen_ld16u(addr, IS_USER(s));
3921 ad69471c pbrook
                    gen_neon_dup_low16(tmp);
3922 9ee6e8bb pbrook
                    break;
3923 9ee6e8bb pbrook
                case 2:
3924 1b2b1e54 Filip Navara
                    tmp = gen_ld32(addr, IS_USER(s));
3925 9ee6e8bb pbrook
                    break;
3926 9ee6e8bb pbrook
                case 3:
3927 9ee6e8bb pbrook
                    return 1;
3928 a50f5b91 pbrook
                default: /* Avoid compiler warnings.  */
3929 a50f5b91 pbrook
                    abort();
3930 99c475ab bellard
                }
3931 1b2b1e54 Filip Navara
                tcg_gen_addi_i32(addr, addr, 1 << size);
3932 ad69471c pbrook
                tmp2 = new_tmp();
3933 ad69471c pbrook
                tcg_gen_mov_i32(tmp2, tmp);
3934 ad69471c pbrook
                neon_store_reg(rd, 0, tmp2);
3935 3018f259 pbrook
                neon_store_reg(rd, 1, tmp);
3936 9ee6e8bb pbrook
                rd += stride;
3937 9ee6e8bb pbrook
            }
3938 9ee6e8bb pbrook
            stride = (1 << size) * nregs;
3939 9ee6e8bb pbrook
        } else {
3940 9ee6e8bb pbrook
            /* Single element.  */
3941 9ee6e8bb pbrook
            pass = (insn >> 7) & 1;
3942 9ee6e8bb pbrook
            switch (size) {
3943 9ee6e8bb pbrook
            case 0:
3944 9ee6e8bb pbrook
                shift = ((insn >> 5) & 3) * 8;
3945 9ee6e8bb pbrook
                stride = 1;
3946 9ee6e8bb pbrook
                break;
3947 9ee6e8bb pbrook
            case 1:
3948 9ee6e8bb pbrook
                shift = ((insn >> 6) & 1) * 16;
3949 9ee6e8bb pbrook
                stride = (insn & (1 << 5)) ? 2 : 1;
3950 9ee6e8bb pbrook
                break;
3951 9ee6e8bb pbrook
            case 2:
3952 9ee6e8bb pbrook
                shift = 0;
3953 9ee6e8bb pbrook
                stride = (insn & (1 << 6)) ? 2 : 1;
3954 9ee6e8bb pbrook
                break;
3955 9ee6e8bb pbrook
            default:
3956 9ee6e8bb pbrook
                abort();
3957 9ee6e8bb pbrook
            }
3958 9ee6e8bb pbrook
            nregs = ((insn >> 8) & 3) + 1;
3959 dcc65026 Aurelien Jarno
            load_reg_var(s, addr, rn);
3960 9ee6e8bb pbrook
            for (reg = 0; reg < nregs; reg++) {
3961 9ee6e8bb pbrook
                if (load) {
3962 9ee6e8bb pbrook
                    switch (size) {
3963 9ee6e8bb pbrook
                    case 0:
3964 1b2b1e54 Filip Navara
                        tmp = gen_ld8u(addr, IS_USER(s));
3965 9ee6e8bb pbrook
                        break;
3966 9ee6e8bb pbrook
                    case 1:
3967 1b2b1e54 Filip Navara
                        tmp = gen_ld16u(addr, IS_USER(s));
3968 9ee6e8bb pbrook
                        break;
3969 9ee6e8bb pbrook
                    case 2:
3970 1b2b1e54 Filip Navara
                        tmp = gen_ld32(addr, IS_USER(s));
3971 9ee6e8bb pbrook
                        break;
3972 a50f5b91 pbrook
                    default: /* Avoid compiler warnings.  */
3973 a50f5b91 pbrook
                        abort();
3974 9ee6e8bb pbrook
                    }
3975 9ee6e8bb pbrook
                    if (size != 2) {
3976 8f8e3aa4 pbrook
                        tmp2 = neon_load_reg(rd, pass);
3977 8f8e3aa4 pbrook
                        gen_bfi(tmp, tmp2, tmp, shift, size ? 0xffff : 0xff);
3978 8f8e3aa4 pbrook
                        dead_tmp(tmp2);
3979 9ee6e8bb pbrook
                    }
3980 8f8e3aa4 pbrook
                    neon_store_reg(rd, pass, tmp);
3981 9ee6e8bb pbrook
                } else { /* Store */
3982 8f8e3aa4 pbrook
                    tmp = neon_load_reg(rd, pass);
3983 8f8e3aa4 pbrook
                    if (shift)
3984 8f8e3aa4 pbrook
                        tcg_gen_shri_i32(tmp, tmp, shift);
3985 9ee6e8bb pbrook
                    switch (size) {
3986 9ee6e8bb pbrook
                    case 0:
3987 1b2b1e54 Filip Navara
                        gen_st8(tmp, addr, IS_USER(s));
3988 9ee6e8bb pbrook
                        break;
3989 9ee6e8bb pbrook
                    case 1:
3990 1b2b1e54 Filip Navara
                        gen_st16(tmp, addr, IS_USER(s));
3991 9ee6e8bb pbrook
                        break;
3992 9ee6e8bb pbrook
                    case 2:
3993 1b2b1e54 Filip Navara
                        gen_st32(tmp, addr, IS_USER(s));
3994 9ee6e8bb pbrook
                        break;
3995 99c475ab bellard
                    }
3996 99c475ab bellard
                }
3997 9ee6e8bb pbrook
                rd += stride;
3998 1b2b1e54 Filip Navara
                tcg_gen_addi_i32(addr, addr, 1 << size);
3999 99c475ab bellard
            }
4000 9ee6e8bb pbrook
            stride = nregs * (1 << size);
4001 99c475ab bellard
        }
4002 9ee6e8bb pbrook
    }
4003 1b2b1e54 Filip Navara
    dead_tmp(addr);
4004 9ee6e8bb pbrook
    if (rm != 15) {
4005 b26eefb6 pbrook
        TCGv base;
4006 b26eefb6 pbrook
4007 b26eefb6 pbrook
        base = load_reg(s, rn);
4008 9ee6e8bb pbrook
        if (rm == 13) {
4009 b26eefb6 pbrook
            tcg_gen_addi_i32(base, base, stride);
4010 9ee6e8bb pbrook
        } else {
4011 b26eefb6 pbrook
            TCGv index;
4012 b26eefb6 pbrook
            index = load_reg(s, rm);
4013 b26eefb6 pbrook
            tcg_gen_add_i32(base, base, index);
4014 b26eefb6 pbrook
            dead_tmp(index);
4015 9ee6e8bb pbrook
        }
4016 b26eefb6 pbrook
        store_reg(s, rn, base);
4017 9ee6e8bb pbrook
    }
4018 9ee6e8bb pbrook
    return 0;
4019 9ee6e8bb pbrook
}
4020 3b46e624 ths
4021 8f8e3aa4 pbrook
/* Bitwise select.  dest = c ? t : f.  Clobbers T and F.  */
4022 8f8e3aa4 pbrook
static void gen_neon_bsl(TCGv dest, TCGv t, TCGv f, TCGv c)
4023 8f8e3aa4 pbrook
{
4024 8f8e3aa4 pbrook
    tcg_gen_and_i32(t, t, c);
4025 f669df27 Aurelien Jarno
    tcg_gen_andc_i32(f, f, c);
4026 8f8e3aa4 pbrook
    tcg_gen_or_i32(dest, t, f);
4027 8f8e3aa4 pbrook
}
4028 8f8e3aa4 pbrook
4029 a7812ae4 pbrook
static inline void gen_neon_narrow(int size, TCGv dest, TCGv_i64 src)
4030 ad69471c pbrook
{
4031 ad69471c pbrook
    switch (size) {
4032 ad69471c pbrook
    case 0: gen_helper_neon_narrow_u8(dest, src); break;
4033 ad69471c pbrook
    case 1: gen_helper_neon_narrow_u16(dest, src); break;
4034 ad69471c pbrook
    case 2: tcg_gen_trunc_i64_i32(dest, src); break;
4035 ad69471c pbrook
    default: abort();
4036 ad69471c pbrook
    }
4037 ad69471c pbrook
}
4038 ad69471c pbrook
4039 a7812ae4 pbrook
static inline void gen_neon_narrow_sats(int size, TCGv dest, TCGv_i64 src)
4040 ad69471c pbrook
{
4041 ad69471c pbrook
    switch (size) {
4042 ad69471c pbrook
    case 0: gen_helper_neon_narrow_sat_s8(dest, cpu_env, src); break;
4043 ad69471c pbrook
    case 1: gen_helper_neon_narrow_sat_s16(dest, cpu_env, src); break;
4044 ad69471c pbrook
    case 2: gen_helper_neon_narrow_sat_s32(dest, cpu_env, src); break;
4045 ad69471c pbrook
    default: abort();
4046 ad69471c pbrook
    }
4047 ad69471c pbrook
}
4048 ad69471c pbrook
4049 a7812ae4 pbrook
static inline void gen_neon_narrow_satu(int size, TCGv dest, TCGv_i64 src)
4050 ad69471c pbrook
{
4051 ad69471c pbrook
    switch (size) {
4052 ad69471c pbrook
    case 0: gen_helper_neon_narrow_sat_u8(dest, cpu_env, src); break;
4053 ad69471c pbrook
    case 1: gen_helper_neon_narrow_sat_u16(dest, cpu_env, src); break;
4054 ad69471c pbrook
    case 2: gen_helper_neon_narrow_sat_u32(dest, cpu_env, src); break;
4055 ad69471c pbrook
    default: abort();
4056 ad69471c pbrook
    }
4057 ad69471c pbrook
}
4058 ad69471c pbrook
4059 ad69471c pbrook
static inline void gen_neon_shift_narrow(int size, TCGv var, TCGv shift,
4060 ad69471c pbrook
                                         int q, int u)
4061 ad69471c pbrook
{
4062 ad69471c pbrook
    if (q) {
4063 ad69471c pbrook
        if (u) {
4064 ad69471c pbrook
            switch (size) {
4065 ad69471c pbrook
            case 1: gen_helper_neon_rshl_u16(var, var, shift); break;
4066 ad69471c pbrook
            case 2: gen_helper_neon_rshl_u32(var, var, shift); break;
4067 ad69471c pbrook
            default: abort();
4068 ad69471c pbrook
            }
4069 ad69471c pbrook
        } else {
4070 ad69471c pbrook
            switch (size) {
4071 ad69471c pbrook
            case 1: gen_helper_neon_rshl_s16(var, var, shift); break;
4072 ad69471c pbrook
            case 2: gen_helper_neon_rshl_s32(var, var, shift); break;
4073 ad69471c pbrook
            default: abort();
4074 ad69471c pbrook
            }
4075 ad69471c pbrook
        }
4076 ad69471c pbrook
    } else {
4077 ad69471c pbrook
        if (u) {
4078 ad69471c pbrook
            switch (size) {
4079 ad69471c pbrook
            case 1: gen_helper_neon_rshl_u16(var, var, shift); break;
4080 ad69471c pbrook
            case 2: gen_helper_neon_rshl_u32(var, var, shift); break;
4081 ad69471c pbrook
            default: abort();
4082 ad69471c pbrook
            }
4083 ad69471c pbrook
        } else {
4084 ad69471c pbrook
            switch (size) {
4085 ad69471c pbrook
            case 1: gen_helper_neon_shl_s16(var, var, shift); break;
4086 ad69471c pbrook
            case 2: gen_helper_neon_shl_s32(var, var, shift); break;
4087 ad69471c pbrook
            default: abort();
4088 ad69471c pbrook
            }
4089 ad69471c pbrook
        }
4090 ad69471c pbrook
    }
4091 ad69471c pbrook
}
4092 ad69471c pbrook
4093 a7812ae4 pbrook
static inline void gen_neon_widen(TCGv_i64 dest, TCGv src, int size, int u)
4094 ad69471c pbrook
{
4095 ad69471c pbrook
    if (u) {
4096 ad69471c pbrook
        switch (size) {
4097 ad69471c pbrook
        case 0: gen_helper_neon_widen_u8(dest, src); break;
4098 ad69471c pbrook
        case 1: gen_helper_neon_widen_u16(dest, src); break;
4099 ad69471c pbrook
        case 2: tcg_gen_extu_i32_i64(dest, src); break;
4100 ad69471c pbrook
        default: abort();
4101 ad69471c pbrook
        }
4102 ad69471c pbrook
    } else {
4103 ad69471c pbrook
        switch (size) {
4104 ad69471c pbrook
        case 0: gen_helper_neon_widen_s8(dest, src); break;
4105 ad69471c pbrook
        case 1: gen_helper_neon_widen_s16(dest, src); break;
4106 ad69471c pbrook
        case 2: tcg_gen_ext_i32_i64(dest, src); break;
4107 ad69471c pbrook
        default: abort();
4108 ad69471c pbrook
        }
4109 ad69471c pbrook
    }
4110 ad69471c pbrook
    dead_tmp(src);
4111 ad69471c pbrook
}
4112 ad69471c pbrook
4113 ad69471c pbrook
static inline void gen_neon_addl(int size)
4114 ad69471c pbrook
{
4115 ad69471c pbrook
    switch (size) {
4116 ad69471c pbrook
    case 0: gen_helper_neon_addl_u16(CPU_V001); break;
4117 ad69471c pbrook
    case 1: gen_helper_neon_addl_u32(CPU_V001); break;
4118 ad69471c pbrook
    case 2: tcg_gen_add_i64(CPU_V001); break;
4119 ad69471c pbrook
    default: abort();
4120 ad69471c pbrook
    }
4121 ad69471c pbrook
}
4122 ad69471c pbrook
4123 ad69471c pbrook
static inline void gen_neon_subl(int size)
4124 ad69471c pbrook
{
4125 ad69471c pbrook
    switch (size) {
4126 ad69471c pbrook
    case 0: gen_helper_neon_subl_u16(CPU_V001); break;
4127 ad69471c pbrook
    case 1: gen_helper_neon_subl_u32(CPU_V001); break;
4128 ad69471c pbrook
    case 2: tcg_gen_sub_i64(CPU_V001); break;
4129 ad69471c pbrook
    default: abort();
4130 ad69471c pbrook
    }
4131 ad69471c pbrook
}
4132 ad69471c pbrook
4133 a7812ae4 pbrook
static inline void gen_neon_negl(TCGv_i64 var, int size)
4134 ad69471c pbrook
{
4135 ad69471c pbrook
    switch (size) {
4136 ad69471c pbrook
    case 0: gen_helper_neon_negl_u16(var, var); break;
4137 ad69471c pbrook
    case 1: gen_helper_neon_negl_u32(var, var); break;
4138 ad69471c pbrook
    case 2: gen_helper_neon_negl_u64(var, var); break;
4139 ad69471c pbrook
    default: abort();
4140 ad69471c pbrook
    }
4141 ad69471c pbrook
}
4142 ad69471c pbrook
4143 a7812ae4 pbrook
static inline void gen_neon_addl_saturate(TCGv_i64 op0, TCGv_i64 op1, int size)
4144 ad69471c pbrook
{
4145 ad69471c pbrook
    switch (size) {
4146 ad69471c pbrook
    case 1: gen_helper_neon_addl_saturate_s32(op0, cpu_env, op0, op1); break;
4147 ad69471c pbrook
    case 2: gen_helper_neon_addl_saturate_s64(op0, cpu_env, op0, op1); break;
4148 ad69471c pbrook
    default: abort();
4149 ad69471c pbrook
    }
4150 ad69471c pbrook
}
4151 ad69471c pbrook
4152 a7812ae4 pbrook
static inline void gen_neon_mull(TCGv_i64 dest, TCGv a, TCGv b, int size, int u)
4153 ad69471c pbrook
{
4154 a7812ae4 pbrook
    TCGv_i64 tmp;
4155 ad69471c pbrook
4156 ad69471c pbrook
    switch ((size << 1) | u) {
4157 ad69471c pbrook
    case 0: gen_helper_neon_mull_s8(dest, a, b); break;
4158 ad69471c pbrook
    case 1: gen_helper_neon_mull_u8(dest, a, b); break;
4159 ad69471c pbrook
    case 2: gen_helper_neon_mull_s16(dest, a, b); break;
4160 ad69471c pbrook
    case 3: gen_helper_neon_mull_u16(dest, a, b); break;
4161 ad69471c pbrook
    case 4:
4162 ad69471c pbrook
        tmp = gen_muls_i64_i32(a, b);
4163 ad69471c pbrook
        tcg_gen_mov_i64(dest, tmp);
4164 ad69471c pbrook
        break;
4165 ad69471c pbrook
    case 5:
4166 ad69471c pbrook
        tmp = gen_mulu_i64_i32(a, b);
4167 ad69471c pbrook
        tcg_gen_mov_i64(dest, tmp);
4168 ad69471c pbrook
        break;
4169 ad69471c pbrook
    default: abort();
4170 ad69471c pbrook
    }
4171 ad69471c pbrook
}
4172 ad69471c pbrook
4173 9ee6e8bb pbrook
/* Translate a NEON data processing instruction.  Return nonzero if the
4174 9ee6e8bb pbrook
   instruction is invalid.
4175 ad69471c pbrook
   We process data in a mixture of 32-bit and 64-bit chunks.
4176 ad69471c pbrook
   Mostly we use 32-bit chunks so we can use normal scalar instructions.  */
4177 2c0262af bellard
4178 9ee6e8bb pbrook
static int disas_neon_data_insn(CPUState * env, DisasContext *s, uint32_t insn)
4179 9ee6e8bb pbrook
{
4180 9ee6e8bb pbrook
    int op;
4181 9ee6e8bb pbrook
    int q;
4182 9ee6e8bb pbrook
    int rd, rn, rm;
4183 9ee6e8bb pbrook
    int size;
4184 9ee6e8bb pbrook
    int shift;
4185 9ee6e8bb pbrook
    int pass;
4186 9ee6e8bb pbrook
    int count;
4187 9ee6e8bb pbrook
    int pairwise;
4188 9ee6e8bb pbrook
    int u;
4189 9ee6e8bb pbrook
    int n;
4190 ca9a32e4 Juha Riihimรคki
    uint32_t imm, mask;
4191 b75263d6 Juha Riihimรคki
    TCGv tmp, tmp2, tmp3, tmp4, tmp5;
4192 a7812ae4 pbrook
    TCGv_i64 tmp64;
4193 9ee6e8bb pbrook
4194 9ee6e8bb pbrook
    if (!vfp_enabled(env))
4195 9ee6e8bb pbrook
      return 1;
4196 9ee6e8bb pbrook
    q = (insn & (1 << 6)) != 0;
4197 9ee6e8bb pbrook
    u = (insn >> 24) & 1;
4198 9ee6e8bb pbrook
    VFP_DREG_D(rd, insn);
4199 9ee6e8bb pbrook
    VFP_DREG_N(rn, insn);
4200 9ee6e8bb pbrook
    VFP_DREG_M(rm, insn);
4201 9ee6e8bb pbrook
    size = (insn >> 20) & 3;
4202 9ee6e8bb pbrook
    if ((insn & (1 << 23)) == 0) {
4203 9ee6e8bb pbrook
        /* Three register same length.  */
4204 9ee6e8bb pbrook
        op = ((insn >> 7) & 0x1e) | ((insn >> 4) & 1);
4205 ad69471c pbrook
        if (size == 3 && (op == 1 || op == 5 || op == 8 || op == 9
4206 ad69471c pbrook
                          || op == 10 || op  == 11 || op == 16)) {
4207 ad69471c pbrook
            /* 64-bit element instructions.  */
4208 9ee6e8bb pbrook
            for (pass = 0; pass < (q ? 2 : 1); pass++) {
4209 ad69471c pbrook
                neon_load_reg64(cpu_V0, rn + pass);
4210 ad69471c pbrook
                neon_load_reg64(cpu_V1, rm + pass);
4211 9ee6e8bb pbrook
                switch (op) {
4212 9ee6e8bb pbrook
                case 1: /* VQADD */
4213 9ee6e8bb pbrook
                    if (u) {
4214 ad69471c pbrook
                        gen_helper_neon_add_saturate_u64(CPU_V001);
4215 2c0262af bellard
                    } else {
4216 ad69471c pbrook
                        gen_helper_neon_add_saturate_s64(CPU_V001);
4217 2c0262af bellard
                    }
4218 9ee6e8bb pbrook
                    break;
4219 9ee6e8bb pbrook
                case 5: /* VQSUB */
4220 9ee6e8bb pbrook
                    if (u) {
4221 ad69471c pbrook
                        gen_helper_neon_sub_saturate_u64(CPU_V001);
4222 ad69471c pbrook
                    } else {
4223 ad69471c pbrook
                        gen_helper_neon_sub_saturate_s64(CPU_V001);
4224 ad69471c pbrook
                    }
4225 ad69471c pbrook
                    break;
4226 ad69471c pbrook
                case 8: /* VSHL */
4227 ad69471c pbrook
                    if (u) {
4228 ad69471c pbrook
                        gen_helper_neon_shl_u64(cpu_V0, cpu_V1, cpu_V0);
4229 ad69471c pbrook
                    } else {
4230 ad69471c pbrook
                        gen_helper_neon_shl_s64(cpu_V0, cpu_V1, cpu_V0);
4231 ad69471c pbrook
                    }
4232 ad69471c pbrook
                    break;
4233 ad69471c pbrook
                case 9: /* VQSHL */
4234 ad69471c pbrook
                    if (u) {
4235 ad69471c pbrook
                        gen_helper_neon_qshl_u64(cpu_V0, cpu_env,
4236 ad69471c pbrook
                                                 cpu_V0, cpu_V0);
4237 ad69471c pbrook
                    } else {
4238 ad69471c pbrook
                        gen_helper_neon_qshl_s64(cpu_V1, cpu_env,
4239 ad69471c pbrook
                                                 cpu_V1, cpu_V0);
4240 ad69471c pbrook
                    }
4241 ad69471c pbrook
                    break;
4242 ad69471c pbrook
                case 10: /* VRSHL */
4243 ad69471c pbrook
                    if (u) {
4244 ad69471c pbrook
                        gen_helper_neon_rshl_u64(cpu_V0, cpu_V1, cpu_V0);
4245 1e8d4eec bellard
                    } else {
4246 ad69471c pbrook
                        gen_helper_neon_rshl_s64(cpu_V0, cpu_V1, cpu_V0);
4247 ad69471c pbrook
                    }
4248 ad69471c pbrook
                    break;
4249 ad69471c pbrook
                case 11: /* VQRSHL */
4250 ad69471c pbrook
                    if (u) {
4251 ad69471c pbrook
                        gen_helper_neon_qrshl_u64(cpu_V0, cpu_env,
4252 ad69471c pbrook
                                                  cpu_V1, cpu_V0);
4253 ad69471c pbrook
                    } else {
4254 ad69471c pbrook
                        gen_helper_neon_qrshl_s64(cpu_V0, cpu_env,
4255 ad69471c pbrook
                                                  cpu_V1, cpu_V0);
4256 1e8d4eec bellard
                    }
4257 9ee6e8bb pbrook
                    break;
4258 9ee6e8bb pbrook
                case 16:
4259 9ee6e8bb pbrook
                    if (u) {
4260 ad69471c pbrook
                        tcg_gen_sub_i64(CPU_V001);
4261 9ee6e8bb pbrook
                    } else {
4262 ad69471c pbrook
                        tcg_gen_add_i64(CPU_V001);
4263 9ee6e8bb pbrook
                    }
4264 9ee6e8bb pbrook
                    break;
4265 9ee6e8bb pbrook
                default:
4266 9ee6e8bb pbrook
                    abort();
4267 2c0262af bellard
                }
4268 ad69471c pbrook
                neon_store_reg64(cpu_V0, rd + pass);
4269 2c0262af bellard
            }
4270 9ee6e8bb pbrook
            return 0;
4271 2c0262af bellard
        }
4272 9ee6e8bb pbrook
        switch (op) {
4273 9ee6e8bb pbrook
        case 8: /* VSHL */
4274 9ee6e8bb pbrook
        case 9: /* VQSHL */
4275 9ee6e8bb pbrook
        case 10: /* VRSHL */
4276 ad69471c pbrook
        case 11: /* VQRSHL */
4277 9ee6e8bb pbrook
            {
4278 ad69471c pbrook
                int rtmp;
4279 ad69471c pbrook
                /* Shift instruction operands are reversed.  */
4280 ad69471c pbrook
                rtmp = rn;
4281 9ee6e8bb pbrook
                rn = rm;
4282 ad69471c pbrook
                rm = rtmp;
4283 9ee6e8bb pbrook
                pairwise = 0;
4284 9ee6e8bb pbrook
            }
4285 2c0262af bellard
            break;
4286 9ee6e8bb pbrook
        case 20: /* VPMAX */
4287 9ee6e8bb pbrook
        case 21: /* VPMIN */
4288 9ee6e8bb pbrook
        case 23: /* VPADD */
4289 9ee6e8bb pbrook
            pairwise = 1;
4290 2c0262af bellard
            break;
4291 9ee6e8bb pbrook
        case 26: /* VPADD (float) */
4292 9ee6e8bb pbrook
            pairwise = (u && size < 2);
4293 2c0262af bellard
            break;
4294 9ee6e8bb pbrook
        case 30: /* VPMIN/VPMAX (float) */
4295 9ee6e8bb pbrook
            pairwise = u;
4296 2c0262af bellard
            break;
4297 9ee6e8bb pbrook
        default:
4298 9ee6e8bb pbrook
            pairwise = 0;
4299 2c0262af bellard
            break;
4300 9ee6e8bb pbrook
        }
4301 dd8fbd78 Filip Navara
4302 9ee6e8bb pbrook
        for (pass = 0; pass < (q ? 4 : 2); pass++) {
4303 9ee6e8bb pbrook
4304 9ee6e8bb pbrook
        if (pairwise) {
4305 9ee6e8bb pbrook
            /* Pairwise.  */
4306 9ee6e8bb pbrook
            if (q)
4307 9ee6e8bb pbrook
                n = (pass & 1) * 2;
4308 2c0262af bellard
            else
4309 9ee6e8bb pbrook
                n = 0;
4310 9ee6e8bb pbrook
            if (pass < q + 1) {
4311 dd8fbd78 Filip Navara
                tmp = neon_load_reg(rn, n);
4312 dd8fbd78 Filip Navara
                tmp2 = neon_load_reg(rn, n + 1);
4313 9ee6e8bb pbrook
            } else {
4314 dd8fbd78 Filip Navara
                tmp = neon_load_reg(rm, n);
4315 dd8fbd78 Filip Navara
                tmp2 = neon_load_reg(rm, n + 1);
4316 9ee6e8bb pbrook
            }
4317 9ee6e8bb pbrook
        } else {
4318 9ee6e8bb pbrook
            /* Elementwise.  */
4319 dd8fbd78 Filip Navara
            tmp = neon_load_reg(rn, pass);
4320 dd8fbd78 Filip Navara
            tmp2 = neon_load_reg(rm, pass);
4321 9ee6e8bb pbrook
        }
4322 9ee6e8bb pbrook
        switch (op) {
4323 9ee6e8bb pbrook
        case 0: /* VHADD */
4324 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(hadd);
4325 9ee6e8bb pbrook
            break;
4326 9ee6e8bb pbrook
        case 1: /* VQADD */
4327 ad69471c pbrook
            GEN_NEON_INTEGER_OP_ENV(qadd);
4328 2c0262af bellard
            break;
4329 9ee6e8bb pbrook
        case 2: /* VRHADD */
4330 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(rhadd);
4331 2c0262af bellard
            break;
4332 9ee6e8bb pbrook
        case 3: /* Logic ops.  */
4333 9ee6e8bb pbrook
            switch ((u << 2) | size) {
4334 9ee6e8bb pbrook
            case 0: /* VAND */
4335 dd8fbd78 Filip Navara
                tcg_gen_and_i32(tmp, tmp, tmp2);
4336 9ee6e8bb pbrook
                break;
4337 9ee6e8bb pbrook
            case 1: /* BIC */
4338 f669df27 Aurelien Jarno
                tcg_gen_andc_i32(tmp, tmp, tmp2);
4339 9ee6e8bb pbrook
                break;
4340 9ee6e8bb pbrook
            case 2: /* VORR */
4341 dd8fbd78 Filip Navara
                tcg_gen_or_i32(tmp, tmp, tmp2);
4342 9ee6e8bb pbrook
                break;
4343 9ee6e8bb pbrook
            case 3: /* VORN */
4344 f669df27 Aurelien Jarno
                tcg_gen_orc_i32(tmp, tmp, tmp2);
4345 9ee6e8bb pbrook
                break;
4346 9ee6e8bb pbrook
            case 4: /* VEOR */
4347 dd8fbd78 Filip Navara
                tcg_gen_xor_i32(tmp, tmp, tmp2);
4348 9ee6e8bb pbrook
                break;
4349 9ee6e8bb pbrook
            case 5: /* VBSL */
4350 dd8fbd78 Filip Navara
                tmp3 = neon_load_reg(rd, pass);
4351 dd8fbd78 Filip Navara
                gen_neon_bsl(tmp, tmp, tmp2, tmp3);
4352 dd8fbd78 Filip Navara
                dead_tmp(tmp3);
4353 9ee6e8bb pbrook
                break;
4354 9ee6e8bb pbrook
            case 6: /* VBIT */
4355 dd8fbd78 Filip Navara
                tmp3 = neon_load_reg(rd, pass);
4356 dd8fbd78 Filip Navara
                gen_neon_bsl(tmp, tmp, tmp3, tmp2);
4357 dd8fbd78 Filip Navara
                dead_tmp(tmp3);
4358 9ee6e8bb pbrook
                break;
4359 9ee6e8bb pbrook
            case 7: /* VBIF */
4360 dd8fbd78 Filip Navara
                tmp3 = neon_load_reg(rd, pass);
4361 dd8fbd78 Filip Navara
                gen_neon_bsl(tmp, tmp3, tmp, tmp2);
4362 dd8fbd78 Filip Navara
                dead_tmp(tmp3);
4363 9ee6e8bb pbrook
                break;
4364 2c0262af bellard
            }
4365 2c0262af bellard
            break;
4366 9ee6e8bb pbrook
        case 4: /* VHSUB */
4367 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(hsub);
4368 9ee6e8bb pbrook
            break;
4369 9ee6e8bb pbrook
        case 5: /* VQSUB */
4370 ad69471c pbrook
            GEN_NEON_INTEGER_OP_ENV(qsub);
4371 2c0262af bellard
            break;
4372 9ee6e8bb pbrook
        case 6: /* VCGT */
4373 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(cgt);
4374 9ee6e8bb pbrook
            break;
4375 9ee6e8bb pbrook
        case 7: /* VCGE */
4376 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(cge);
4377 9ee6e8bb pbrook
            break;
4378 9ee6e8bb pbrook
        case 8: /* VSHL */
4379 ad69471c pbrook
            GEN_NEON_INTEGER_OP(shl);
4380 2c0262af bellard
            break;
4381 9ee6e8bb pbrook
        case 9: /* VQSHL */
4382 ad69471c pbrook
            GEN_NEON_INTEGER_OP_ENV(qshl);
4383 2c0262af bellard
            break;
4384 9ee6e8bb pbrook
        case 10: /* VRSHL */
4385 ad69471c pbrook
            GEN_NEON_INTEGER_OP(rshl);
4386 2c0262af bellard
            break;
4387 9ee6e8bb pbrook
        case 11: /* VQRSHL */
4388 ad69471c pbrook
            GEN_NEON_INTEGER_OP_ENV(qrshl);
4389 9ee6e8bb pbrook
            break;
4390 9ee6e8bb pbrook
        case 12: /* VMAX */
4391 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(max);
4392 9ee6e8bb pbrook
            break;
4393 9ee6e8bb pbrook
        case 13: /* VMIN */
4394 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(min);
4395 9ee6e8bb pbrook
            break;
4396 9ee6e8bb pbrook
        case 14: /* VABD */
4397 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(abd);
4398 9ee6e8bb pbrook
            break;
4399 9ee6e8bb pbrook
        case 15: /* VABA */
4400 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(abd);
4401 dd8fbd78 Filip Navara
            dead_tmp(tmp2);
4402 dd8fbd78 Filip Navara
            tmp2 = neon_load_reg(rd, pass);
4403 dd8fbd78 Filip Navara
            gen_neon_add(size, tmp, tmp2);
4404 9ee6e8bb pbrook
            break;
4405 9ee6e8bb pbrook
        case 16:
4406 9ee6e8bb pbrook
            if (!u) { /* VADD */
4407 dd8fbd78 Filip Navara
                if (gen_neon_add(size, tmp, tmp2))
4408 9ee6e8bb pbrook
                    return 1;
4409 9ee6e8bb pbrook
            } else { /* VSUB */
4410 9ee6e8bb pbrook
                switch (size) {
4411 dd8fbd78 Filip Navara
                case 0: gen_helper_neon_sub_u8(tmp, tmp, tmp2); break;
4412 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_sub_u16(tmp, tmp, tmp2); break;
4413 dd8fbd78 Filip Navara
                case 2: tcg_gen_sub_i32(tmp, tmp, tmp2); break;
4414 9ee6e8bb pbrook
                default: return 1;
4415 9ee6e8bb pbrook
                }
4416 9ee6e8bb pbrook
            }
4417 9ee6e8bb pbrook
            break;
4418 9ee6e8bb pbrook
        case 17:
4419 9ee6e8bb pbrook
            if (!u) { /* VTST */
4420 9ee6e8bb pbrook
                switch (size) {
4421 dd8fbd78 Filip Navara
                case 0: gen_helper_neon_tst_u8(tmp, tmp, tmp2); break;
4422 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_tst_u16(tmp, tmp, tmp2); break;
4423 dd8fbd78 Filip Navara
                case 2: gen_helper_neon_tst_u32(tmp, tmp, tmp2); break;
4424 9ee6e8bb pbrook
                default: return 1;
4425 9ee6e8bb pbrook
                }
4426 9ee6e8bb pbrook
            } else { /* VCEQ */
4427 9ee6e8bb pbrook
                switch (size) {
4428 dd8fbd78 Filip Navara
                case 0: gen_helper_neon_ceq_u8(tmp, tmp, tmp2); break;
4429 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_ceq_u16(tmp, tmp, tmp2); break;
4430 dd8fbd78 Filip Navara
                case 2: gen_helper_neon_ceq_u32(tmp, tmp, tmp2); break;
4431 9ee6e8bb pbrook
                default: return 1;
4432 9ee6e8bb pbrook
                }
4433 9ee6e8bb pbrook
            }
4434 9ee6e8bb pbrook
            break;
4435 9ee6e8bb pbrook
        case 18: /* Multiply.  */
4436 9ee6e8bb pbrook
            switch (size) {
4437 dd8fbd78 Filip Navara
            case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
4438 dd8fbd78 Filip Navara
            case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
4439 dd8fbd78 Filip Navara
            case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
4440 9ee6e8bb pbrook
            default: return 1;
4441 9ee6e8bb pbrook
            }
4442 dd8fbd78 Filip Navara
            dead_tmp(tmp2);
4443 dd8fbd78 Filip Navara
            tmp2 = neon_load_reg(rd, pass);
4444 9ee6e8bb pbrook
            if (u) { /* VMLS */
4445 dd8fbd78 Filip Navara
                gen_neon_rsb(size, tmp, tmp2);
4446 9ee6e8bb pbrook
            } else { /* VMLA */
4447 dd8fbd78 Filip Navara
                gen_neon_add(size, tmp, tmp2);
4448 9ee6e8bb pbrook
            }
4449 9ee6e8bb pbrook
            break;
4450 9ee6e8bb pbrook
        case 19: /* VMUL */
4451 9ee6e8bb pbrook
            if (u) { /* polynomial */
4452 dd8fbd78 Filip Navara
                gen_helper_neon_mul_p8(tmp, tmp, tmp2);
4453 9ee6e8bb pbrook
            } else { /* Integer */
4454 9ee6e8bb pbrook
                switch (size) {
4455 dd8fbd78 Filip Navara
                case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
4456 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
4457 dd8fbd78 Filip Navara
                case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
4458 9ee6e8bb pbrook
                default: return 1;
4459 9ee6e8bb pbrook
                }
4460 9ee6e8bb pbrook
            }
4461 9ee6e8bb pbrook
            break;
4462 9ee6e8bb pbrook
        case 20: /* VPMAX */
4463 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(pmax);
4464 9ee6e8bb pbrook
            break;
4465 9ee6e8bb pbrook
        case 21: /* VPMIN */
4466 9ee6e8bb pbrook
            GEN_NEON_INTEGER_OP(pmin);
4467 9ee6e8bb pbrook
            break;
4468 9ee6e8bb pbrook
        case 22: /* Hultiply high.  */
4469 9ee6e8bb pbrook
            if (!u) { /* VQDMULH */
4470 9ee6e8bb pbrook
                switch (size) {
4471 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_qdmulh_s16(tmp, cpu_env, tmp, tmp2); break;
4472 dd8fbd78 Filip Navara
                case 2: gen_helper_neon_qdmulh_s32(tmp, cpu_env, tmp, tmp2); break;
4473 9ee6e8bb pbrook
                default: return 1;
4474 9ee6e8bb pbrook
                }
4475 9ee6e8bb pbrook
            } else { /* VQRDHMUL */
4476 9ee6e8bb pbrook
                switch (size) {
4477 dd8fbd78 Filip Navara
                case 1: gen_helper_neon_qrdmulh_s16(tmp, cpu_env, tmp, tmp2); break;
4478 dd8fbd78 Filip Navara
                case 2: gen_helper_neon_qrdmulh_s32(tmp, cpu_env, tmp, tmp2); break;
4479 9ee6e8bb pbrook
                default: return 1;
4480 9ee6e8bb pbrook
                }
4481 9ee6e8bb pbrook
            }
4482 9ee6e8bb pbrook
            break;
4483 9ee6e8bb pbrook
        case 23: /* VPADD */
4484 9ee6e8bb pbrook
            if (u)
4485 9ee6e8bb pbrook
                return 1;
4486 9ee6e8bb pbrook
            switch (size) {
4487 dd8fbd78 Filip Navara
            case 0: gen_helper_neon_padd_u8(tmp, tmp, tmp2); break;
4488 dd8fbd78 Filip Navara
            case 1: gen_helper_neon_padd_u16(tmp, tmp, tmp2); break;
4489 dd8fbd78 Filip Navara
            case 2: tcg_gen_add_i32(tmp, tmp, tmp2); break;
4490 9ee6e8bb pbrook
            default: return 1;
4491 9ee6e8bb pbrook
            }
4492 9ee6e8bb pbrook
            break;
4493 9ee6e8bb pbrook
        case 26: /* Floating point arithnetic.  */
4494 9ee6e8bb pbrook
            switch ((u << 2) | size) {
4495 9ee6e8bb pbrook
            case 0: /* VADD */
4496 dd8fbd78 Filip Navara
                gen_helper_neon_add_f32(tmp, tmp, tmp2);
4497 9ee6e8bb pbrook
                break;
4498 9ee6e8bb pbrook
            case 2: /* VSUB */
4499 dd8fbd78 Filip Navara
                gen_helper_neon_sub_f32(tmp, tmp, tmp2);
4500 9ee6e8bb pbrook
                break;
4501 9ee6e8bb pbrook
            case 4: /* VPADD */
4502 dd8fbd78 Filip Navara
                gen_helper_neon_add_f32(tmp, tmp, tmp2);
4503 9ee6e8bb pbrook
                break;
4504 9ee6e8bb pbrook
            case 6: /* VABD */
4505 dd8fbd78 Filip Navara
                gen_helper_neon_abd_f32(tmp, tmp, tmp2);
4506 9ee6e8bb pbrook
                break;
4507 9ee6e8bb pbrook
            default:
4508 9ee6e8bb pbrook
                return 1;
4509 9ee6e8bb pbrook
            }
4510 9ee6e8bb pbrook
            break;
4511 9ee6e8bb pbrook
        case 27: /* Float multiply.  */
4512 dd8fbd78 Filip Navara
            gen_helper_neon_mul_f32(tmp, tmp, tmp2);
4513 9ee6e8bb pbrook
            if (!u) {
4514 dd8fbd78 Filip Navara
                dead_tmp(tmp2);
4515 dd8fbd78 Filip Navara
                tmp2 = neon_load_reg(rd, pass);
4516 9ee6e8bb pbrook
                if (size == 0) {
4517 dd8fbd78 Filip Navara
                    gen_helper_neon_add_f32(tmp, tmp, tmp2);
4518 9ee6e8bb pbrook
                } else {
4519 dd8fbd78 Filip Navara
                    gen_helper_neon_sub_f32(tmp, tmp2, tmp);
4520 9ee6e8bb pbrook
                }
4521 9ee6e8bb pbrook
            }
4522 9ee6e8bb pbrook
            break;
4523 9ee6e8bb pbrook
        case 28: /* Float compare.  */
4524 9ee6e8bb pbrook
            if (!u) {
4525 dd8fbd78 Filip Navara
                gen_helper_neon_ceq_f32(tmp, tmp, tmp2);
4526 b5ff1b31 bellard
            } else {
4527 9ee6e8bb pbrook
                if (size == 0)
4528 dd8fbd78 Filip Navara
                    gen_helper_neon_cge_f32(tmp, tmp, tmp2);
4529 9ee6e8bb pbrook
                else
4530 dd8fbd78 Filip Navara
                    gen_helper_neon_cgt_f32(tmp, tmp, tmp2);
4531 b5ff1b31 bellard
            }
4532 2c0262af bellard
            break;
4533 9ee6e8bb pbrook
        case 29: /* Float compare absolute.  */
4534 9ee6e8bb pbrook
            if (!u)
4535 9ee6e8bb pbrook
                return 1;
4536 9ee6e8bb pbrook
            if (size == 0)
4537 dd8fbd78 Filip Navara
                gen_helper_neon_acge_f32(tmp, tmp, tmp2);
4538 9ee6e8bb pbrook
            else
4539 dd8fbd78 Filip Navara
                gen_helper_neon_acgt_f32(tmp, tmp, tmp2);
4540 2c0262af bellard
            break;
4541 9ee6e8bb pbrook
        case 30: /* Float min/max.  */
4542 9ee6e8bb pbrook
            if (size == 0)
4543 dd8fbd78 Filip Navara
                gen_helper_neon_max_f32(tmp, tmp, tmp2);
4544 9ee6e8bb pbrook
            else
4545 dd8fbd78 Filip Navara
                gen_helper_neon_min_f32(tmp, tmp, tmp2);
4546 9ee6e8bb pbrook
            break;
4547 9ee6e8bb pbrook
        case 31:
4548 9ee6e8bb pbrook
            if (size == 0)
4549 dd8fbd78 Filip Navara
                gen_helper_recps_f32(tmp, tmp, tmp2, cpu_env);
4550 9ee6e8bb pbrook
            else
4551 dd8fbd78 Filip Navara
                gen_helper_rsqrts_f32(tmp, tmp, tmp2, cpu_env);
4552 2c0262af bellard
            break;
4553 9ee6e8bb pbrook
        default:
4554 9ee6e8bb pbrook
            abort();
4555 2c0262af bellard
        }
4556 dd8fbd78 Filip Navara
        dead_tmp(tmp2);
4557 dd8fbd78 Filip Navara
4558 9ee6e8bb pbrook
        /* Save the result.  For elementwise operations we can put it
4559 9ee6e8bb pbrook
           straight into the destination register.  For pairwise operations
4560 9ee6e8bb pbrook
           we have to be careful to avoid clobbering the source operands.  */
4561 9ee6e8bb pbrook
        if (pairwise && rd == rm) {
4562 dd8fbd78 Filip Navara
            neon_store_scratch(pass, tmp);
4563 9ee6e8bb pbrook
        } else {
4564 dd8fbd78 Filip Navara
            neon_store_reg(rd, pass, tmp);
4565 9ee6e8bb pbrook
        }
4566 9ee6e8bb pbrook
4567 9ee6e8bb pbrook
        } /* for pass */
4568 9ee6e8bb pbrook
        if (pairwise && rd == rm) {
4569 9ee6e8bb pbrook
            for (pass = 0; pass < (q ? 4 : 2); pass++) {
4570 dd8fbd78 Filip Navara
                tmp = neon_load_scratch(pass);
4571 dd8fbd78 Filip Navara
                neon_store_reg(rd, pass, tmp);
4572 9ee6e8bb pbrook
            }
4573 9ee6e8bb pbrook
        }
4574 ad69471c pbrook
        /* End of 3 register same size operations.  */
4575 9ee6e8bb pbrook
    } else if (insn & (1 << 4)) {
4576 9ee6e8bb pbrook
        if ((insn & 0x00380080) != 0) {
4577 9ee6e8bb pbrook
            /* Two registers and shift.  */
4578 9ee6e8bb pbrook
            op = (insn >> 8) & 0xf;
4579 9ee6e8bb pbrook
            if (insn & (1 << 7)) {
4580 9ee6e8bb pbrook
                /* 64-bit shift.   */
4581 9ee6e8bb pbrook
                size = 3;
4582 9ee6e8bb pbrook
            } else {
4583 9ee6e8bb pbrook
                size = 2;
4584 9ee6e8bb pbrook
                while ((insn & (1 << (size + 19))) == 0)
4585 9ee6e8bb pbrook
                    size--;
4586 9ee6e8bb pbrook
            }
4587 9ee6e8bb pbrook
            shift = (insn >> 16) & ((1 << (3 + size)) - 1);
4588 9ee6e8bb pbrook
            /* To avoid excessive dumplication of ops we implement shift
4589 9ee6e8bb pbrook
               by immediate using the variable shift operations.  */
4590 9ee6e8bb pbrook
            if (op < 8) {
4591 9ee6e8bb pbrook
                /* Shift by immediate:
4592 9ee6e8bb pbrook
                   VSHR, VSRA, VRSHR, VRSRA, VSRI, VSHL, VQSHL, VQSHLU.  */
4593 9ee6e8bb pbrook
                /* Right shifts are encoded as N - shift, where N is the
4594 9ee6e8bb pbrook
                   element size in bits.  */
4595 9ee6e8bb pbrook
                if (op <= 4)
4596 9ee6e8bb pbrook
                    shift = shift - (1 << (size + 3));
4597 9ee6e8bb pbrook
                if (size == 3) {
4598 9ee6e8bb pbrook
                    count = q + 1;
4599 9ee6e8bb pbrook
                } else {
4600 9ee6e8bb pbrook
                    count = q ? 4: 2;
4601 9ee6e8bb pbrook
                }
4602 9ee6e8bb pbrook
                switch (size) {
4603 9ee6e8bb pbrook
                case 0:
4604 9ee6e8bb pbrook
                    imm = (uint8_t) shift;
4605 9ee6e8bb pbrook
                    imm |= imm << 8;
4606 9ee6e8bb pbrook
                    imm |= imm << 16;
4607 9ee6e8bb pbrook
                    break;
4608 9ee6e8bb pbrook
                case 1:
4609 9ee6e8bb pbrook
                    imm = (uint16_t) shift;
4610 9ee6e8bb pbrook
                    imm |= imm << 16;
4611 9ee6e8bb pbrook
                    break;
4612 9ee6e8bb pbrook
                case 2:
4613 9ee6e8bb pbrook
                case 3:
4614 9ee6e8bb pbrook
                    imm = shift;
4615 9ee6e8bb pbrook
                    break;
4616 9ee6e8bb pbrook
                default:
4617 9ee6e8bb pbrook
                    abort();
4618 9ee6e8bb pbrook
                }
4619 9ee6e8bb pbrook
4620 9ee6e8bb pbrook
                for (pass = 0; pass < count; pass++) {
4621 ad69471c pbrook
                    if (size == 3) {
4622 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rm + pass);
4623 ad69471c pbrook
                        tcg_gen_movi_i64(cpu_V1, imm);
4624 ad69471c pbrook
                        switch (op) {
4625 ad69471c pbrook
                        case 0:  /* VSHR */
4626 ad69471c pbrook
                        case 1:  /* VSRA */
4627 ad69471c pbrook
                            if (u)
4628 ad69471c pbrook
                                gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
4629 9ee6e8bb pbrook
                            else
4630 ad69471c pbrook
                                gen_helper_neon_shl_s64(cpu_V0, cpu_V0, cpu_V1);
4631 9ee6e8bb pbrook
                            break;
4632 ad69471c pbrook
                        case 2: /* VRSHR */
4633 ad69471c pbrook
                        case 3: /* VRSRA */
4634 ad69471c pbrook
                            if (u)
4635 ad69471c pbrook
                                gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, cpu_V1);
4636 9ee6e8bb pbrook
                            else
4637 ad69471c pbrook
                                gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, cpu_V1);
4638 9ee6e8bb pbrook
                            break;
4639 ad69471c pbrook
                        case 4: /* VSRI */
4640 ad69471c pbrook
                            if (!u)
4641 ad69471c pbrook
                                return 1;
4642 ad69471c pbrook
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
4643 ad69471c pbrook
                            break;
4644 ad69471c pbrook
                        case 5: /* VSHL, VSLI */
4645 ad69471c pbrook
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, cpu_V1);
4646 ad69471c pbrook
                            break;
4647 ad69471c pbrook
                        case 6: /* VQSHL */
4648 ad69471c pbrook
                            if (u)
4649 ad69471c pbrook
                                gen_helper_neon_qshl_u64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
4650 9ee6e8bb pbrook
                            else
4651 ad69471c pbrook
                                gen_helper_neon_qshl_s64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
4652 ad69471c pbrook
                            break;
4653 ad69471c pbrook
                        case 7: /* VQSHLU */
4654 ad69471c pbrook
                            gen_helper_neon_qshl_u64(cpu_V0, cpu_env, cpu_V0, cpu_V1);
4655 9ee6e8bb pbrook
                            break;
4656 9ee6e8bb pbrook
                        }
4657 ad69471c pbrook
                        if (op == 1 || op == 3) {
4658 ad69471c pbrook
                            /* Accumulate.  */
4659 ad69471c pbrook
                            neon_load_reg64(cpu_V0, rd + pass);
4660 ad69471c pbrook
                            tcg_gen_add_i64(cpu_V0, cpu_V0, cpu_V1);
4661 ad69471c pbrook
                        } else if (op == 4 || (op == 5 && u)) {
4662 ad69471c pbrook
                            /* Insert */
4663 ad69471c pbrook
                            cpu_abort(env, "VS[LR]I.64 not implemented");
4664 ad69471c pbrook
                        }
4665 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
4666 ad69471c pbrook
                    } else { /* size < 3 */
4667 ad69471c pbrook
                        /* Operands in T0 and T1.  */
4668 dd8fbd78 Filip Navara
                        tmp = neon_load_reg(rm, pass);
4669 dd8fbd78 Filip Navara
                        tmp2 = new_tmp();
4670 dd8fbd78 Filip Navara
                        tcg_gen_movi_i32(tmp2, imm);
4671 ad69471c pbrook
                        switch (op) {
4672 ad69471c pbrook
                        case 0:  /* VSHR */
4673 ad69471c pbrook
                        case 1:  /* VSRA */
4674 ad69471c pbrook
                            GEN_NEON_INTEGER_OP(shl);
4675 ad69471c pbrook
                            break;
4676 ad69471c pbrook
                        case 2: /* VRSHR */
4677 ad69471c pbrook
                        case 3: /* VRSRA */
4678 ad69471c pbrook
                            GEN_NEON_INTEGER_OP(rshl);
4679 ad69471c pbrook
                            break;
4680 ad69471c pbrook
                        case 4: /* VSRI */
4681 ad69471c pbrook
                            if (!u)
4682 ad69471c pbrook
                                return 1;
4683 ad69471c pbrook
                            GEN_NEON_INTEGER_OP(shl);
4684 ad69471c pbrook
                            break;
4685 ad69471c pbrook
                        case 5: /* VSHL, VSLI */
4686 ad69471c pbrook
                            switch (size) {
4687 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_shl_u8(tmp, tmp, tmp2); break;
4688 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_shl_u16(tmp, tmp, tmp2); break;
4689 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_shl_u32(tmp, tmp, tmp2); break;
4690 ad69471c pbrook
                            default: return 1;
4691 ad69471c pbrook
                            }
4692 ad69471c pbrook
                            break;
4693 ad69471c pbrook
                        case 6: /* VQSHL */
4694 ad69471c pbrook
                            GEN_NEON_INTEGER_OP_ENV(qshl);
4695 ad69471c pbrook
                            break;
4696 ad69471c pbrook
                        case 7: /* VQSHLU */
4697 ad69471c pbrook
                            switch (size) {
4698 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_qshl_u8(tmp, cpu_env, tmp, tmp2); break;
4699 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_qshl_u16(tmp, cpu_env, tmp, tmp2); break;
4700 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_qshl_u32(tmp, cpu_env, tmp, tmp2); break;
4701 ad69471c pbrook
                            default: return 1;
4702 ad69471c pbrook
                            }
4703 ad69471c pbrook
                            break;
4704 ad69471c pbrook
                        }
4705 dd8fbd78 Filip Navara
                        dead_tmp(tmp2);
4706 ad69471c pbrook
4707 ad69471c pbrook
                        if (op == 1 || op == 3) {
4708 ad69471c pbrook
                            /* Accumulate.  */
4709 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, pass);
4710 dd8fbd78 Filip Navara
                            gen_neon_add(size, tmp2, tmp);
4711 dd8fbd78 Filip Navara
                            dead_tmp(tmp2);
4712 ad69471c pbrook
                        } else if (op == 4 || (op == 5 && u)) {
4713 ad69471c pbrook
                            /* Insert */
4714 ad69471c pbrook
                            switch (size) {
4715 ad69471c pbrook
                            case 0:
4716 ad69471c pbrook
                                if (op == 4)
4717 ca9a32e4 Juha Riihimรคki
                                    mask = 0xff >> -shift;
4718 ad69471c pbrook
                                else
4719 ca9a32e4 Juha Riihimรคki
                                    mask = (uint8_t)(0xff << shift);
4720 ca9a32e4 Juha Riihimรคki
                                mask |= mask << 8;
4721 ca9a32e4 Juha Riihimรคki
                                mask |= mask << 16;
4722 ad69471c pbrook
                                break;
4723 ad69471c pbrook
                            case 1:
4724 ad69471c pbrook
                                if (op == 4)
4725 ca9a32e4 Juha Riihimรคki
                                    mask = 0xffff >> -shift;
4726 ad69471c pbrook
                                else
4727 ca9a32e4 Juha Riihimรคki
                                    mask = (uint16_t)(0xffff << shift);
4728 ca9a32e4 Juha Riihimรคki
                                mask |= mask << 16;
4729 ad69471c pbrook
                                break;
4730 ad69471c pbrook
                            case 2:
4731 ca9a32e4 Juha Riihimรคki
                                if (shift < -31 || shift > 31) {
4732 ca9a32e4 Juha Riihimรคki
                                    mask = 0;
4733 ca9a32e4 Juha Riihimรคki
                                } else {
4734 ca9a32e4 Juha Riihimรคki
                                    if (op == 4)
4735 ca9a32e4 Juha Riihimรคki
                                        mask = 0xffffffffu >> -shift;
4736 ca9a32e4 Juha Riihimรคki
                                    else
4737 ca9a32e4 Juha Riihimรคki
                                        mask = 0xffffffffu << shift;
4738 ca9a32e4 Juha Riihimรคki
                                }
4739 ad69471c pbrook
                                break;
4740 ad69471c pbrook
                            default:
4741 ad69471c pbrook
                                abort();
4742 ad69471c pbrook
                            }
4743 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, pass);
4744 ca9a32e4 Juha Riihimรคki
                            tcg_gen_andi_i32(tmp, tmp, mask);
4745 ca9a32e4 Juha Riihimรคki
                            tcg_gen_andi_i32(tmp2, tmp2, ~mask);
4746 dd8fbd78 Filip Navara
                            tcg_gen_or_i32(tmp, tmp, tmp2);
4747 dd8fbd78 Filip Navara
                            dead_tmp(tmp2);
4748 ad69471c pbrook
                        }
4749 dd8fbd78 Filip Navara
                        neon_store_reg(rd, pass, tmp);
4750 9ee6e8bb pbrook
                    }
4751 9ee6e8bb pbrook
                } /* for pass */
4752 9ee6e8bb pbrook
            } else if (op < 10) {
4753 ad69471c pbrook
                /* Shift by immediate and narrow:
4754 9ee6e8bb pbrook
                   VSHRN, VRSHRN, VQSHRN, VQRSHRN.  */
4755 9ee6e8bb pbrook
                shift = shift - (1 << (size + 3));
4756 9ee6e8bb pbrook
                size++;
4757 9ee6e8bb pbrook
                switch (size) {
4758 9ee6e8bb pbrook
                case 1:
4759 ad69471c pbrook
                    imm = (uint16_t)shift;
4760 9ee6e8bb pbrook
                    imm |= imm << 16;
4761 ad69471c pbrook
                    tmp2 = tcg_const_i32(imm);
4762 a7812ae4 pbrook
                    TCGV_UNUSED_I64(tmp64);
4763 9ee6e8bb pbrook
                    break;
4764 9ee6e8bb pbrook
                case 2:
4765 ad69471c pbrook
                    imm = (uint32_t)shift;
4766 ad69471c pbrook
                    tmp2 = tcg_const_i32(imm);
4767 a7812ae4 pbrook
                    TCGV_UNUSED_I64(tmp64);
4768 4cc633c3 balrog
                    break;
4769 9ee6e8bb pbrook
                case 3:
4770 a7812ae4 pbrook
                    tmp64 = tcg_const_i64(shift);
4771 a7812ae4 pbrook
                    TCGV_UNUSED(tmp2);
4772 9ee6e8bb pbrook
                    break;
4773 9ee6e8bb pbrook
                default:
4774 9ee6e8bb pbrook
                    abort();
4775 9ee6e8bb pbrook
                }
4776 9ee6e8bb pbrook
4777 ad69471c pbrook
                for (pass = 0; pass < 2; pass++) {
4778 ad69471c pbrook
                    if (size == 3) {
4779 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rm + pass);
4780 ad69471c pbrook
                        if (q) {
4781 ad69471c pbrook
                          if (u)
4782 a7812ae4 pbrook
                            gen_helper_neon_rshl_u64(cpu_V0, cpu_V0, tmp64);
4783 ad69471c pbrook
                          else
4784 a7812ae4 pbrook
                            gen_helper_neon_rshl_s64(cpu_V0, cpu_V0, tmp64);
4785 ad69471c pbrook
                        } else {
4786 ad69471c pbrook
                          if (u)
4787 a7812ae4 pbrook
                            gen_helper_neon_shl_u64(cpu_V0, cpu_V0, tmp64);
4788 ad69471c pbrook
                          else
4789 a7812ae4 pbrook
                            gen_helper_neon_shl_s64(cpu_V0, cpu_V0, tmp64);
4790 ad69471c pbrook
                        }
4791 2c0262af bellard
                    } else {
4792 ad69471c pbrook
                        tmp = neon_load_reg(rm + pass, 0);
4793 ad69471c pbrook
                        gen_neon_shift_narrow(size, tmp, tmp2, q, u);
4794 36aa55dc pbrook
                        tmp3 = neon_load_reg(rm + pass, 1);
4795 36aa55dc pbrook
                        gen_neon_shift_narrow(size, tmp3, tmp2, q, u);
4796 36aa55dc pbrook
                        tcg_gen_concat_i32_i64(cpu_V0, tmp, tmp3);
4797 ad69471c pbrook
                        dead_tmp(tmp);
4798 36aa55dc pbrook
                        dead_tmp(tmp3);
4799 9ee6e8bb pbrook
                    }
4800 ad69471c pbrook
                    tmp = new_tmp();
4801 ad69471c pbrook
                    if (op == 8 && !u) {
4802 ad69471c pbrook
                        gen_neon_narrow(size - 1, tmp, cpu_V0);
4803 9ee6e8bb pbrook
                    } else {
4804 ad69471c pbrook
                        if (op == 8)
4805 ad69471c pbrook
                            gen_neon_narrow_sats(size - 1, tmp, cpu_V0);
4806 9ee6e8bb pbrook
                        else
4807 ad69471c pbrook
                            gen_neon_narrow_satu(size - 1, tmp, cpu_V0);
4808 ad69471c pbrook
                    }
4809 2301db49 Juha Riihimรคki
                    neon_store_reg(rd, pass, tmp);
4810 9ee6e8bb pbrook
                } /* for pass */
4811 b75263d6 Juha Riihimรคki
                if (size == 3) {
4812 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i64(tmp64);
4813 2301db49 Juha Riihimรคki
                } else {
4814 2301db49 Juha Riihimรคki
                    dead_tmp(tmp2);
4815 b75263d6 Juha Riihimรคki
                }
4816 9ee6e8bb pbrook
            } else if (op == 10) {
4817 9ee6e8bb pbrook
                /* VSHLL */
4818 ad69471c pbrook
                if (q || size == 3)
4819 9ee6e8bb pbrook
                    return 1;
4820 ad69471c pbrook
                tmp = neon_load_reg(rm, 0);
4821 ad69471c pbrook
                tmp2 = neon_load_reg(rm, 1);
4822 9ee6e8bb pbrook
                for (pass = 0; pass < 2; pass++) {
4823 ad69471c pbrook
                    if (pass == 1)
4824 ad69471c pbrook
                        tmp = tmp2;
4825 ad69471c pbrook
4826 ad69471c pbrook
                    gen_neon_widen(cpu_V0, tmp, size, u);
4827 9ee6e8bb pbrook
4828 9ee6e8bb pbrook
                    if (shift != 0) {
4829 9ee6e8bb pbrook
                        /* The shift is less than the width of the source
4830 ad69471c pbrook
                           type, so we can just shift the whole register.  */
4831 ad69471c pbrook
                        tcg_gen_shli_i64(cpu_V0, cpu_V0, shift);
4832 ad69471c pbrook
                        if (size < 2 || !u) {
4833 ad69471c pbrook
                            uint64_t imm64;
4834 ad69471c pbrook
                            if (size == 0) {
4835 ad69471c pbrook
                                imm = (0xffu >> (8 - shift));
4836 ad69471c pbrook
                                imm |= imm << 16;
4837 ad69471c pbrook
                            } else {
4838 ad69471c pbrook
                                imm = 0xffff >> (16 - shift);
4839 9ee6e8bb pbrook
                            }
4840 ad69471c pbrook
                            imm64 = imm | (((uint64_t)imm) << 32);
4841 ad69471c pbrook
                            tcg_gen_andi_i64(cpu_V0, cpu_V0, imm64);
4842 9ee6e8bb pbrook
                        }
4843 9ee6e8bb pbrook
                    }
4844 ad69471c pbrook
                    neon_store_reg64(cpu_V0, rd + pass);
4845 9ee6e8bb pbrook
                }
4846 9ee6e8bb pbrook
            } else if (op == 15 || op == 16) {
4847 9ee6e8bb pbrook
                /* VCVT fixed-point.  */
4848 9ee6e8bb pbrook
                for (pass = 0; pass < (q ? 4 : 2); pass++) {
4849 4373f3ce pbrook
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, pass));
4850 9ee6e8bb pbrook
                    if (op & 1) {
4851 9ee6e8bb pbrook
                        if (u)
4852 4373f3ce pbrook
                            gen_vfp_ulto(0, shift);
4853 9ee6e8bb pbrook
                        else
4854 4373f3ce pbrook
                            gen_vfp_slto(0, shift);
4855 9ee6e8bb pbrook
                    } else {
4856 9ee6e8bb pbrook
                        if (u)
4857 4373f3ce pbrook
                            gen_vfp_toul(0, shift);
4858 9ee6e8bb pbrook
                        else
4859 4373f3ce pbrook
                            gen_vfp_tosl(0, shift);
4860 2c0262af bellard
                    }
4861 4373f3ce pbrook
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, pass));
4862 2c0262af bellard
                }
4863 2c0262af bellard
            } else {
4864 9ee6e8bb pbrook
                return 1;
4865 9ee6e8bb pbrook
            }
4866 9ee6e8bb pbrook
        } else { /* (insn & 0x00380080) == 0 */
4867 9ee6e8bb pbrook
            int invert;
4868 9ee6e8bb pbrook
4869 9ee6e8bb pbrook
            op = (insn >> 8) & 0xf;
4870 9ee6e8bb pbrook
            /* One register and immediate.  */
4871 9ee6e8bb pbrook
            imm = (u << 7) | ((insn >> 12) & 0x70) | (insn & 0xf);
4872 9ee6e8bb pbrook
            invert = (insn & (1 << 5)) != 0;
4873 9ee6e8bb pbrook
            switch (op) {
4874 9ee6e8bb pbrook
            case 0: case 1:
4875 9ee6e8bb pbrook
                /* no-op */
4876 9ee6e8bb pbrook
                break;
4877 9ee6e8bb pbrook
            case 2: case 3:
4878 9ee6e8bb pbrook
                imm <<= 8;
4879 9ee6e8bb pbrook
                break;
4880 9ee6e8bb pbrook
            case 4: case 5:
4881 9ee6e8bb pbrook
                imm <<= 16;
4882 9ee6e8bb pbrook
                break;
4883 9ee6e8bb pbrook
            case 6: case 7:
4884 9ee6e8bb pbrook
                imm <<= 24;
4885 9ee6e8bb pbrook
                break;
4886 9ee6e8bb pbrook
            case 8: case 9:
4887 9ee6e8bb pbrook
                imm |= imm << 16;
4888 9ee6e8bb pbrook
                break;
4889 9ee6e8bb pbrook
            case 10: case 11:
4890 9ee6e8bb pbrook
                imm = (imm << 8) | (imm << 24);
4891 9ee6e8bb pbrook
                break;
4892 9ee6e8bb pbrook
            case 12:
4893 9ee6e8bb pbrook
                imm = (imm < 8) | 0xff;
4894 9ee6e8bb pbrook
                break;
4895 9ee6e8bb pbrook
            case 13:
4896 9ee6e8bb pbrook
                imm = (imm << 16) | 0xffff;
4897 9ee6e8bb pbrook
                break;
4898 9ee6e8bb pbrook
            case 14:
4899 9ee6e8bb pbrook
                imm |= (imm << 8) | (imm << 16) | (imm << 24);
4900 9ee6e8bb pbrook
                if (invert)
4901 9ee6e8bb pbrook
                    imm = ~imm;
4902 9ee6e8bb pbrook
                break;
4903 9ee6e8bb pbrook
            case 15:
4904 9ee6e8bb pbrook
                imm = ((imm & 0x80) << 24) | ((imm & 0x3f) << 19)
4905 9ee6e8bb pbrook
                      | ((imm & 0x40) ? (0x1f << 25) : (1 << 30));
4906 9ee6e8bb pbrook
                break;
4907 9ee6e8bb pbrook
            }
4908 9ee6e8bb pbrook
            if (invert)
4909 9ee6e8bb pbrook
                imm = ~imm;
4910 9ee6e8bb pbrook
4911 9ee6e8bb pbrook
            for (pass = 0; pass < (q ? 4 : 2); pass++) {
4912 9ee6e8bb pbrook
                if (op & 1 && op < 12) {
4913 ad69471c pbrook
                    tmp = neon_load_reg(rd, pass);
4914 9ee6e8bb pbrook
                    if (invert) {
4915 9ee6e8bb pbrook
                        /* The immediate value has already been inverted, so
4916 9ee6e8bb pbrook
                           BIC becomes AND.  */
4917 ad69471c pbrook
                        tcg_gen_andi_i32(tmp, tmp, imm);
4918 9ee6e8bb pbrook
                    } else {
4919 ad69471c pbrook
                        tcg_gen_ori_i32(tmp, tmp, imm);
4920 9ee6e8bb pbrook
                    }
4921 9ee6e8bb pbrook
                } else {
4922 ad69471c pbrook
                    /* VMOV, VMVN.  */
4923 ad69471c pbrook
                    tmp = new_tmp();
4924 9ee6e8bb pbrook
                    if (op == 14 && invert) {
4925 ad69471c pbrook
                        uint32_t val;
4926 ad69471c pbrook
                        val = 0;
4927 9ee6e8bb pbrook
                        for (n = 0; n < 4; n++) {
4928 9ee6e8bb pbrook
                            if (imm & (1 << (n + (pass & 1) * 4)))
4929 ad69471c pbrook
                                val |= 0xff << (n * 8);
4930 9ee6e8bb pbrook
                        }
4931 ad69471c pbrook
                        tcg_gen_movi_i32(tmp, val);
4932 ad69471c pbrook
                    } else {
4933 ad69471c pbrook
                        tcg_gen_movi_i32(tmp, imm);
4934 9ee6e8bb pbrook
                    }
4935 9ee6e8bb pbrook
                }
4936 ad69471c pbrook
                neon_store_reg(rd, pass, tmp);
4937 9ee6e8bb pbrook
            }
4938 9ee6e8bb pbrook
        }
4939 e4b3861d pbrook
    } else { /* (insn & 0x00800010 == 0x00800000) */
4940 9ee6e8bb pbrook
        if (size != 3) {
4941 9ee6e8bb pbrook
            op = (insn >> 8) & 0xf;
4942 9ee6e8bb pbrook
            if ((insn & (1 << 6)) == 0) {
4943 9ee6e8bb pbrook
                /* Three registers of different lengths.  */
4944 9ee6e8bb pbrook
                int src1_wide;
4945 9ee6e8bb pbrook
                int src2_wide;
4946 9ee6e8bb pbrook
                int prewiden;
4947 9ee6e8bb pbrook
                /* prewiden, src1_wide, src2_wide */
4948 9ee6e8bb pbrook
                static const int neon_3reg_wide[16][3] = {
4949 9ee6e8bb pbrook
                    {1, 0, 0}, /* VADDL */
4950 9ee6e8bb pbrook
                    {1, 1, 0}, /* VADDW */
4951 9ee6e8bb pbrook
                    {1, 0, 0}, /* VSUBL */
4952 9ee6e8bb pbrook
                    {1, 1, 0}, /* VSUBW */
4953 9ee6e8bb pbrook
                    {0, 1, 1}, /* VADDHN */
4954 9ee6e8bb pbrook
                    {0, 0, 0}, /* VABAL */
4955 9ee6e8bb pbrook
                    {0, 1, 1}, /* VSUBHN */
4956 9ee6e8bb pbrook
                    {0, 0, 0}, /* VABDL */
4957 9ee6e8bb pbrook
                    {0, 0, 0}, /* VMLAL */
4958 9ee6e8bb pbrook
                    {0, 0, 0}, /* VQDMLAL */
4959 9ee6e8bb pbrook
                    {0, 0, 0}, /* VMLSL */
4960 9ee6e8bb pbrook
                    {0, 0, 0}, /* VQDMLSL */
4961 9ee6e8bb pbrook
                    {0, 0, 0}, /* Integer VMULL */
4962 9ee6e8bb pbrook
                    {0, 0, 0}, /* VQDMULL */
4963 9ee6e8bb pbrook
                    {0, 0, 0}  /* Polynomial VMULL */
4964 9ee6e8bb pbrook
                };
4965 9ee6e8bb pbrook
4966 9ee6e8bb pbrook
                prewiden = neon_3reg_wide[op][0];
4967 9ee6e8bb pbrook
                src1_wide = neon_3reg_wide[op][1];
4968 9ee6e8bb pbrook
                src2_wide = neon_3reg_wide[op][2];
4969 9ee6e8bb pbrook
4970 ad69471c pbrook
                if (size == 0 && (op == 9 || op == 11 || op == 13))
4971 ad69471c pbrook
                    return 1;
4972 ad69471c pbrook
4973 9ee6e8bb pbrook
                /* Avoid overlapping operands.  Wide source operands are
4974 9ee6e8bb pbrook
                   always aligned so will never overlap with wide
4975 9ee6e8bb pbrook
                   destinations in problematic ways.  */
4976 8f8e3aa4 pbrook
                if (rd == rm && !src2_wide) {
4977 dd8fbd78 Filip Navara
                    tmp = neon_load_reg(rm, 1);
4978 dd8fbd78 Filip Navara
                    neon_store_scratch(2, tmp);
4979 8f8e3aa4 pbrook
                } else if (rd == rn && !src1_wide) {
4980 dd8fbd78 Filip Navara
                    tmp = neon_load_reg(rn, 1);
4981 dd8fbd78 Filip Navara
                    neon_store_scratch(2, tmp);
4982 9ee6e8bb pbrook
                }
4983 a50f5b91 pbrook
                TCGV_UNUSED(tmp3);
4984 9ee6e8bb pbrook
                for (pass = 0; pass < 2; pass++) {
4985 ad69471c pbrook
                    if (src1_wide) {
4986 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rn + pass);
4987 a50f5b91 pbrook
                        TCGV_UNUSED(tmp);
4988 9ee6e8bb pbrook
                    } else {
4989 ad69471c pbrook
                        if (pass == 1 && rd == rn) {
4990 dd8fbd78 Filip Navara
                            tmp = neon_load_scratch(2);
4991 9ee6e8bb pbrook
                        } else {
4992 ad69471c pbrook
                            tmp = neon_load_reg(rn, pass);
4993 ad69471c pbrook
                        }
4994 ad69471c pbrook
                        if (prewiden) {
4995 ad69471c pbrook
                            gen_neon_widen(cpu_V0, tmp, size, u);
4996 9ee6e8bb pbrook
                        }
4997 9ee6e8bb pbrook
                    }
4998 ad69471c pbrook
                    if (src2_wide) {
4999 ad69471c pbrook
                        neon_load_reg64(cpu_V1, rm + pass);
5000 a50f5b91 pbrook
                        TCGV_UNUSED(tmp2);
5001 9ee6e8bb pbrook
                    } else {
5002 ad69471c pbrook
                        if (pass == 1 && rd == rm) {
5003 dd8fbd78 Filip Navara
                            tmp2 = neon_load_scratch(2);
5004 9ee6e8bb pbrook
                        } else {
5005 ad69471c pbrook
                            tmp2 = neon_load_reg(rm, pass);
5006 ad69471c pbrook
                        }
5007 ad69471c pbrook
                        if (prewiden) {
5008 ad69471c pbrook
                            gen_neon_widen(cpu_V1, tmp2, size, u);
5009 9ee6e8bb pbrook
                        }
5010 9ee6e8bb pbrook
                    }
5011 9ee6e8bb pbrook
                    switch (op) {
5012 9ee6e8bb pbrook
                    case 0: case 1: case 4: /* VADDL, VADDW, VADDHN, VRADDHN */
5013 ad69471c pbrook
                        gen_neon_addl(size);
5014 9ee6e8bb pbrook
                        break;
5015 9ee6e8bb pbrook
                    case 2: case 3: case 6: /* VSUBL, VSUBW, VSUBHL, VRSUBHL */
5016 ad69471c pbrook
                        gen_neon_subl(size);
5017 9ee6e8bb pbrook
                        break;
5018 9ee6e8bb pbrook
                    case 5: case 7: /* VABAL, VABDL */
5019 9ee6e8bb pbrook
                        switch ((size << 1) | u) {
5020 ad69471c pbrook
                        case 0:
5021 ad69471c pbrook
                            gen_helper_neon_abdl_s16(cpu_V0, tmp, tmp2);
5022 ad69471c pbrook
                            break;
5023 ad69471c pbrook
                        case 1:
5024 ad69471c pbrook
                            gen_helper_neon_abdl_u16(cpu_V0, tmp, tmp2);
5025 ad69471c pbrook
                            break;
5026 ad69471c pbrook
                        case 2:
5027 ad69471c pbrook
                            gen_helper_neon_abdl_s32(cpu_V0, tmp, tmp2);
5028 ad69471c pbrook
                            break;
5029 ad69471c pbrook
                        case 3:
5030 ad69471c pbrook
                            gen_helper_neon_abdl_u32(cpu_V0, tmp, tmp2);
5031 ad69471c pbrook
                            break;
5032 ad69471c pbrook
                        case 4:
5033 ad69471c pbrook
                            gen_helper_neon_abdl_s64(cpu_V0, tmp, tmp2);
5034 ad69471c pbrook
                            break;
5035 ad69471c pbrook
                        case 5:
5036 ad69471c pbrook
                            gen_helper_neon_abdl_u64(cpu_V0, tmp, tmp2);
5037 ad69471c pbrook
                            break;
5038 9ee6e8bb pbrook
                        default: abort();
5039 9ee6e8bb pbrook
                        }
5040 ad69471c pbrook
                        dead_tmp(tmp2);
5041 ad69471c pbrook
                        dead_tmp(tmp);
5042 9ee6e8bb pbrook
                        break;
5043 9ee6e8bb pbrook
                    case 8: case 9: case 10: case 11: case 12: case 13:
5044 9ee6e8bb pbrook
                        /* VMLAL, VQDMLAL, VMLSL, VQDMLSL, VMULL, VQDMULL */
5045 ad69471c pbrook
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
5046 dd8fbd78 Filip Navara
                        dead_tmp(tmp2);
5047 dd8fbd78 Filip Navara
                        dead_tmp(tmp);
5048 9ee6e8bb pbrook
                        break;
5049 9ee6e8bb pbrook
                    case 14: /* Polynomial VMULL */
5050 9ee6e8bb pbrook
                        cpu_abort(env, "Polynomial VMULL not implemented");
5051 9ee6e8bb pbrook
5052 9ee6e8bb pbrook
                    default: /* 15 is RESERVED.  */
5053 9ee6e8bb pbrook
                        return 1;
5054 9ee6e8bb pbrook
                    }
5055 9ee6e8bb pbrook
                    if (op == 5 || op == 13 || (op >= 8 && op <= 11)) {
5056 9ee6e8bb pbrook
                        /* Accumulate.  */
5057 9ee6e8bb pbrook
                        if (op == 10 || op == 11) {
5058 ad69471c pbrook
                            gen_neon_negl(cpu_V0, size);
5059 9ee6e8bb pbrook
                        }
5060 9ee6e8bb pbrook
5061 9ee6e8bb pbrook
                        if (op != 13) {
5062 ad69471c pbrook
                            neon_load_reg64(cpu_V1, rd + pass);
5063 9ee6e8bb pbrook
                        }
5064 9ee6e8bb pbrook
5065 9ee6e8bb pbrook
                        switch (op) {
5066 9ee6e8bb pbrook
                        case 5: case 8: case 10: /* VABAL, VMLAL, VMLSL */
5067 ad69471c pbrook
                            gen_neon_addl(size);
5068 9ee6e8bb pbrook
                            break;
5069 9ee6e8bb pbrook
                        case 9: case 11: /* VQDMLAL, VQDMLSL */
5070 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
5071 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
5072 ad69471c pbrook
                            break;
5073 9ee6e8bb pbrook
                            /* Fall through.  */
5074 9ee6e8bb pbrook
                        case 13: /* VQDMULL */
5075 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
5076 9ee6e8bb pbrook
                            break;
5077 9ee6e8bb pbrook
                        default:
5078 9ee6e8bb pbrook
                            abort();
5079 9ee6e8bb pbrook
                        }
5080 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
5081 9ee6e8bb pbrook
                    } else if (op == 4 || op == 6) {
5082 9ee6e8bb pbrook
                        /* Narrowing operation.  */
5083 ad69471c pbrook
                        tmp = new_tmp();
5084 9ee6e8bb pbrook
                        if (u) {
5085 9ee6e8bb pbrook
                            switch (size) {
5086 ad69471c pbrook
                            case 0:
5087 ad69471c pbrook
                                gen_helper_neon_narrow_high_u8(tmp, cpu_V0);
5088 ad69471c pbrook
                                break;
5089 ad69471c pbrook
                            case 1:
5090 ad69471c pbrook
                                gen_helper_neon_narrow_high_u16(tmp, cpu_V0);
5091 ad69471c pbrook
                                break;
5092 ad69471c pbrook
                            case 2:
5093 ad69471c pbrook
                                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
5094 ad69471c pbrook
                                tcg_gen_trunc_i64_i32(tmp, cpu_V0);
5095 ad69471c pbrook
                                break;
5096 9ee6e8bb pbrook
                            default: abort();
5097 9ee6e8bb pbrook
                            }
5098 9ee6e8bb pbrook
                        } else {
5099 9ee6e8bb pbrook
                            switch (size) {
5100 ad69471c pbrook
                            case 0:
5101 ad69471c pbrook
                                gen_helper_neon_narrow_round_high_u8(tmp, cpu_V0);
5102 ad69471c pbrook
                                break;
5103 ad69471c pbrook
                            case 1:
5104 ad69471c pbrook
                                gen_helper_neon_narrow_round_high_u16(tmp, cpu_V0);
5105 ad69471c pbrook
                                break;
5106 ad69471c pbrook
                            case 2:
5107 ad69471c pbrook
                                tcg_gen_addi_i64(cpu_V0, cpu_V0, 1u << 31);
5108 ad69471c pbrook
                                tcg_gen_shri_i64(cpu_V0, cpu_V0, 32);
5109 ad69471c pbrook
                                tcg_gen_trunc_i64_i32(tmp, cpu_V0);
5110 ad69471c pbrook
                                break;
5111 9ee6e8bb pbrook
                            default: abort();
5112 9ee6e8bb pbrook
                            }
5113 9ee6e8bb pbrook
                        }
5114 ad69471c pbrook
                        if (pass == 0) {
5115 ad69471c pbrook
                            tmp3 = tmp;
5116 ad69471c pbrook
                        } else {
5117 ad69471c pbrook
                            neon_store_reg(rd, 0, tmp3);
5118 ad69471c pbrook
                            neon_store_reg(rd, 1, tmp);
5119 ad69471c pbrook
                        }
5120 9ee6e8bb pbrook
                    } else {
5121 9ee6e8bb pbrook
                        /* Write back the result.  */
5122 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
5123 9ee6e8bb pbrook
                    }
5124 9ee6e8bb pbrook
                }
5125 9ee6e8bb pbrook
            } else {
5126 9ee6e8bb pbrook
                /* Two registers and a scalar.  */
5127 9ee6e8bb pbrook
                switch (op) {
5128 9ee6e8bb pbrook
                case 0: /* Integer VMLA scalar */
5129 9ee6e8bb pbrook
                case 1: /* Float VMLA scalar */
5130 9ee6e8bb pbrook
                case 4: /* Integer VMLS scalar */
5131 9ee6e8bb pbrook
                case 5: /* Floating point VMLS scalar */
5132 9ee6e8bb pbrook
                case 8: /* Integer VMUL scalar */
5133 9ee6e8bb pbrook
                case 9: /* Floating point VMUL scalar */
5134 9ee6e8bb pbrook
                case 12: /* VQDMULH scalar */
5135 9ee6e8bb pbrook
                case 13: /* VQRDMULH scalar */
5136 dd8fbd78 Filip Navara
                    tmp = neon_get_scalar(size, rm);
5137 dd8fbd78 Filip Navara
                    neon_store_scratch(0, tmp);
5138 9ee6e8bb pbrook
                    for (pass = 0; pass < (u ? 4 : 2); pass++) {
5139 dd8fbd78 Filip Navara
                        tmp = neon_load_scratch(0);
5140 dd8fbd78 Filip Navara
                        tmp2 = neon_load_reg(rn, pass);
5141 9ee6e8bb pbrook
                        if (op == 12) {
5142 9ee6e8bb pbrook
                            if (size == 1) {
5143 dd8fbd78 Filip Navara
                                gen_helper_neon_qdmulh_s16(tmp, cpu_env, tmp, tmp2);
5144 9ee6e8bb pbrook
                            } else {
5145 dd8fbd78 Filip Navara
                                gen_helper_neon_qdmulh_s32(tmp, cpu_env, tmp, tmp2);
5146 9ee6e8bb pbrook
                            }
5147 9ee6e8bb pbrook
                        } else if (op == 13) {
5148 9ee6e8bb pbrook
                            if (size == 1) {
5149 dd8fbd78 Filip Navara
                                gen_helper_neon_qrdmulh_s16(tmp, cpu_env, tmp, tmp2);
5150 9ee6e8bb pbrook
                            } else {
5151 dd8fbd78 Filip Navara
                                gen_helper_neon_qrdmulh_s32(tmp, cpu_env, tmp, tmp2);
5152 9ee6e8bb pbrook
                            }
5153 9ee6e8bb pbrook
                        } else if (op & 1) {
5154 dd8fbd78 Filip Navara
                            gen_helper_neon_mul_f32(tmp, tmp, tmp2);
5155 9ee6e8bb pbrook
                        } else {
5156 9ee6e8bb pbrook
                            switch (size) {
5157 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_mul_u8(tmp, tmp, tmp2); break;
5158 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_mul_u16(tmp, tmp, tmp2); break;
5159 dd8fbd78 Filip Navara
                            case 2: tcg_gen_mul_i32(tmp, tmp, tmp2); break;
5160 9ee6e8bb pbrook
                            default: return 1;
5161 9ee6e8bb pbrook
                            }
5162 9ee6e8bb pbrook
                        }
5163 dd8fbd78 Filip Navara
                        dead_tmp(tmp2);
5164 9ee6e8bb pbrook
                        if (op < 8) {
5165 9ee6e8bb pbrook
                            /* Accumulate.  */
5166 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, pass);
5167 9ee6e8bb pbrook
                            switch (op) {
5168 9ee6e8bb pbrook
                            case 0:
5169 dd8fbd78 Filip Navara
                                gen_neon_add(size, tmp, tmp2);
5170 9ee6e8bb pbrook
                                break;
5171 9ee6e8bb pbrook
                            case 1:
5172 dd8fbd78 Filip Navara
                                gen_helper_neon_add_f32(tmp, tmp, tmp2);
5173 9ee6e8bb pbrook
                                break;
5174 9ee6e8bb pbrook
                            case 4:
5175 dd8fbd78 Filip Navara
                                gen_neon_rsb(size, tmp, tmp2);
5176 9ee6e8bb pbrook
                                break;
5177 9ee6e8bb pbrook
                            case 5:
5178 dd8fbd78 Filip Navara
                                gen_helper_neon_sub_f32(tmp, tmp2, tmp);
5179 9ee6e8bb pbrook
                                break;
5180 9ee6e8bb pbrook
                            default:
5181 9ee6e8bb pbrook
                                abort();
5182 9ee6e8bb pbrook
                            }
5183 dd8fbd78 Filip Navara
                            dead_tmp(tmp2);
5184 9ee6e8bb pbrook
                        }
5185 dd8fbd78 Filip Navara
                        neon_store_reg(rd, pass, tmp);
5186 9ee6e8bb pbrook
                    }
5187 9ee6e8bb pbrook
                    break;
5188 9ee6e8bb pbrook
                case 2: /* VMLAL sclar */
5189 9ee6e8bb pbrook
                case 3: /* VQDMLAL scalar */
5190 9ee6e8bb pbrook
                case 6: /* VMLSL scalar */
5191 9ee6e8bb pbrook
                case 7: /* VQDMLSL scalar */
5192 9ee6e8bb pbrook
                case 10: /* VMULL scalar */
5193 9ee6e8bb pbrook
                case 11: /* VQDMULL scalar */
5194 ad69471c pbrook
                    if (size == 0 && (op == 3 || op == 7 || op == 11))
5195 ad69471c pbrook
                        return 1;
5196 ad69471c pbrook
5197 dd8fbd78 Filip Navara
                    tmp2 = neon_get_scalar(size, rm);
5198 dd8fbd78 Filip Navara
                    tmp3 = neon_load_reg(rn, 1);
5199 ad69471c pbrook
5200 9ee6e8bb pbrook
                    for (pass = 0; pass < 2; pass++) {
5201 ad69471c pbrook
                        if (pass == 0) {
5202 ad69471c pbrook
                            tmp = neon_load_reg(rn, 0);
5203 9ee6e8bb pbrook
                        } else {
5204 dd8fbd78 Filip Navara
                            tmp = tmp3;
5205 9ee6e8bb pbrook
                        }
5206 ad69471c pbrook
                        gen_neon_mull(cpu_V0, tmp, tmp2, size, u);
5207 dd8fbd78 Filip Navara
                        dead_tmp(tmp);
5208 9ee6e8bb pbrook
                        if (op == 6 || op == 7) {
5209 ad69471c pbrook
                            gen_neon_negl(cpu_V0, size);
5210 ad69471c pbrook
                        }
5211 ad69471c pbrook
                        if (op != 11) {
5212 ad69471c pbrook
                            neon_load_reg64(cpu_V1, rd + pass);
5213 9ee6e8bb pbrook
                        }
5214 9ee6e8bb pbrook
                        switch (op) {
5215 9ee6e8bb pbrook
                        case 2: case 6:
5216 ad69471c pbrook
                            gen_neon_addl(size);
5217 9ee6e8bb pbrook
                            break;
5218 9ee6e8bb pbrook
                        case 3: case 7:
5219 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
5220 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V1, size);
5221 9ee6e8bb pbrook
                            break;
5222 9ee6e8bb pbrook
                        case 10:
5223 9ee6e8bb pbrook
                            /* no-op */
5224 9ee6e8bb pbrook
                            break;
5225 9ee6e8bb pbrook
                        case 11:
5226 ad69471c pbrook
                            gen_neon_addl_saturate(cpu_V0, cpu_V0, size);
5227 9ee6e8bb pbrook
                            break;
5228 9ee6e8bb pbrook
                        default:
5229 9ee6e8bb pbrook
                            abort();
5230 9ee6e8bb pbrook
                        }
5231 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
5232 9ee6e8bb pbrook
                    }
5233 dd8fbd78 Filip Navara
5234 dd8fbd78 Filip Navara
                    dead_tmp(tmp2);
5235 dd8fbd78 Filip Navara
5236 9ee6e8bb pbrook
                    break;
5237 9ee6e8bb pbrook
                default: /* 14 and 15 are RESERVED */
5238 9ee6e8bb pbrook
                    return 1;
5239 9ee6e8bb pbrook
                }
5240 9ee6e8bb pbrook
            }
5241 9ee6e8bb pbrook
        } else { /* size == 3 */
5242 9ee6e8bb pbrook
            if (!u) {
5243 9ee6e8bb pbrook
                /* Extract.  */
5244 9ee6e8bb pbrook
                imm = (insn >> 8) & 0xf;
5245 ad69471c pbrook
                count = q + 1;
5246 ad69471c pbrook
5247 ad69471c pbrook
                if (imm > 7 && !q)
5248 ad69471c pbrook
                    return 1;
5249 ad69471c pbrook
5250 ad69471c pbrook
                if (imm == 0) {
5251 ad69471c pbrook
                    neon_load_reg64(cpu_V0, rn);
5252 ad69471c pbrook
                    if (q) {
5253 ad69471c pbrook
                        neon_load_reg64(cpu_V1, rn + 1);
5254 9ee6e8bb pbrook
                    }
5255 ad69471c pbrook
                } else if (imm == 8) {
5256 ad69471c pbrook
                    neon_load_reg64(cpu_V0, rn + 1);
5257 ad69471c pbrook
                    if (q) {
5258 ad69471c pbrook
                        neon_load_reg64(cpu_V1, rm);
5259 9ee6e8bb pbrook
                    }
5260 ad69471c pbrook
                } else if (q) {
5261 a7812ae4 pbrook
                    tmp64 = tcg_temp_new_i64();
5262 ad69471c pbrook
                    if (imm < 8) {
5263 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rn);
5264 a7812ae4 pbrook
                        neon_load_reg64(tmp64, rn + 1);
5265 ad69471c pbrook
                    } else {
5266 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rn + 1);
5267 a7812ae4 pbrook
                        neon_load_reg64(tmp64, rm);
5268 ad69471c pbrook
                    }
5269 ad69471c pbrook
                    tcg_gen_shri_i64(cpu_V0, cpu_V0, (imm & 7) * 8);
5270 a7812ae4 pbrook
                    tcg_gen_shli_i64(cpu_V1, tmp64, 64 - ((imm & 7) * 8));
5271 ad69471c pbrook
                    tcg_gen_or_i64(cpu_V0, cpu_V0, cpu_V1);
5272 ad69471c pbrook
                    if (imm < 8) {
5273 ad69471c pbrook
                        neon_load_reg64(cpu_V1, rm);
5274 9ee6e8bb pbrook
                    } else {
5275 ad69471c pbrook
                        neon_load_reg64(cpu_V1, rm + 1);
5276 ad69471c pbrook
                        imm -= 8;
5277 9ee6e8bb pbrook
                    }
5278 ad69471c pbrook
                    tcg_gen_shli_i64(cpu_V1, cpu_V1, 64 - (imm * 8));
5279 a7812ae4 pbrook
                    tcg_gen_shri_i64(tmp64, tmp64, imm * 8);
5280 a7812ae4 pbrook
                    tcg_gen_or_i64(cpu_V1, cpu_V1, tmp64);
5281 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i64(tmp64);
5282 ad69471c pbrook
                } else {
5283 a7812ae4 pbrook
                    /* BUGFIX */
5284 ad69471c pbrook
                    neon_load_reg64(cpu_V0, rn);
5285 a7812ae4 pbrook
                    tcg_gen_shri_i64(cpu_V0, cpu_V0, imm * 8);
5286 ad69471c pbrook
                    neon_load_reg64(cpu_V1, rm);
5287 a7812ae4 pbrook
                    tcg_gen_shli_i64(cpu_V1, cpu_V1, 64 - (imm * 8));
5288 ad69471c pbrook
                    tcg_gen_or_i64(cpu_V0, cpu_V0, cpu_V1);
5289 ad69471c pbrook
                }
5290 ad69471c pbrook
                neon_store_reg64(cpu_V0, rd);
5291 ad69471c pbrook
                if (q) {
5292 ad69471c pbrook
                    neon_store_reg64(cpu_V1, rd + 1);
5293 9ee6e8bb pbrook
                }
5294 9ee6e8bb pbrook
            } else if ((insn & (1 << 11)) == 0) {
5295 9ee6e8bb pbrook
                /* Two register misc.  */
5296 9ee6e8bb pbrook
                op = ((insn >> 12) & 0x30) | ((insn >> 7) & 0xf);
5297 9ee6e8bb pbrook
                size = (insn >> 18) & 3;
5298 9ee6e8bb pbrook
                switch (op) {
5299 9ee6e8bb pbrook
                case 0: /* VREV64 */
5300 9ee6e8bb pbrook
                    if (size == 3)
5301 9ee6e8bb pbrook
                        return 1;
5302 9ee6e8bb pbrook
                    for (pass = 0; pass < (q ? 2 : 1); pass++) {
5303 dd8fbd78 Filip Navara
                        tmp = neon_load_reg(rm, pass * 2);
5304 dd8fbd78 Filip Navara
                        tmp2 = neon_load_reg(rm, pass * 2 + 1);
5305 9ee6e8bb pbrook
                        switch (size) {
5306 dd8fbd78 Filip Navara
                        case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
5307 dd8fbd78 Filip Navara
                        case 1: gen_swap_half(tmp); break;
5308 9ee6e8bb pbrook
                        case 2: /* no-op */ break;
5309 9ee6e8bb pbrook
                        default: abort();
5310 9ee6e8bb pbrook
                        }
5311 dd8fbd78 Filip Navara
                        neon_store_reg(rd, pass * 2 + 1, tmp);
5312 9ee6e8bb pbrook
                        if (size == 2) {
5313 dd8fbd78 Filip Navara
                            neon_store_reg(rd, pass * 2, tmp2);
5314 9ee6e8bb pbrook
                        } else {
5315 9ee6e8bb pbrook
                            switch (size) {
5316 dd8fbd78 Filip Navara
                            case 0: tcg_gen_bswap32_i32(tmp2, tmp2); break;
5317 dd8fbd78 Filip Navara
                            case 1: gen_swap_half(tmp2); break;
5318 9ee6e8bb pbrook
                            default: abort();
5319 9ee6e8bb pbrook
                            }
5320 dd8fbd78 Filip Navara
                            neon_store_reg(rd, pass * 2, tmp2);
5321 9ee6e8bb pbrook
                        }
5322 9ee6e8bb pbrook
                    }
5323 9ee6e8bb pbrook
                    break;
5324 9ee6e8bb pbrook
                case 4: case 5: /* VPADDL */
5325 9ee6e8bb pbrook
                case 12: case 13: /* VPADAL */
5326 9ee6e8bb pbrook
                    if (size == 3)
5327 9ee6e8bb pbrook
                        return 1;
5328 ad69471c pbrook
                    for (pass = 0; pass < q + 1; pass++) {
5329 ad69471c pbrook
                        tmp = neon_load_reg(rm, pass * 2);
5330 ad69471c pbrook
                        gen_neon_widen(cpu_V0, tmp, size, op & 1);
5331 ad69471c pbrook
                        tmp = neon_load_reg(rm, pass * 2 + 1);
5332 ad69471c pbrook
                        gen_neon_widen(cpu_V1, tmp, size, op & 1);
5333 ad69471c pbrook
                        switch (size) {
5334 ad69471c pbrook
                        case 0: gen_helper_neon_paddl_u16(CPU_V001); break;
5335 ad69471c pbrook
                        case 1: gen_helper_neon_paddl_u32(CPU_V001); break;
5336 ad69471c pbrook
                        case 2: tcg_gen_add_i64(CPU_V001); break;
5337 ad69471c pbrook
                        default: abort();
5338 ad69471c pbrook
                        }
5339 9ee6e8bb pbrook
                        if (op >= 12) {
5340 9ee6e8bb pbrook
                            /* Accumulate.  */
5341 ad69471c pbrook
                            neon_load_reg64(cpu_V1, rd + pass);
5342 ad69471c pbrook
                            gen_neon_addl(size);
5343 9ee6e8bb pbrook
                        }
5344 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
5345 9ee6e8bb pbrook
                    }
5346 9ee6e8bb pbrook
                    break;
5347 9ee6e8bb pbrook
                case 33: /* VTRN */
5348 9ee6e8bb pbrook
                    if (size == 2) {
5349 9ee6e8bb pbrook
                        for (n = 0; n < (q ? 4 : 2); n += 2) {
5350 dd8fbd78 Filip Navara
                            tmp = neon_load_reg(rm, n);
5351 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, n + 1);
5352 dd8fbd78 Filip Navara
                            neon_store_reg(rm, n, tmp2);
5353 dd8fbd78 Filip Navara
                            neon_store_reg(rd, n + 1, tmp);
5354 9ee6e8bb pbrook
                        }
5355 9ee6e8bb pbrook
                    } else {
5356 9ee6e8bb pbrook
                        goto elementwise;
5357 9ee6e8bb pbrook
                    }
5358 9ee6e8bb pbrook
                    break;
5359 9ee6e8bb pbrook
                case 34: /* VUZP */
5360 9ee6e8bb pbrook
                    /* Reg  Before       After
5361 9ee6e8bb pbrook
                       Rd   A3 A2 A1 A0  B2 B0 A2 A0
5362 9ee6e8bb pbrook
                       Rm   B3 B2 B1 B0  B3 B1 A3 A1
5363 9ee6e8bb pbrook
                     */
5364 9ee6e8bb pbrook
                    if (size == 3)
5365 9ee6e8bb pbrook
                        return 1;
5366 9ee6e8bb pbrook
                    gen_neon_unzip(rd, q, 0, size);
5367 9ee6e8bb pbrook
                    gen_neon_unzip(rm, q, 4, size);
5368 9ee6e8bb pbrook
                    if (q) {
5369 9ee6e8bb pbrook
                        static int unzip_order_q[8] =
5370 9ee6e8bb pbrook
                            {0, 2, 4, 6, 1, 3, 5, 7};
5371 9ee6e8bb pbrook
                        for (n = 0; n < 8; n++) {
5372 9ee6e8bb pbrook
                            int reg = (n < 4) ? rd : rm;
5373 dd8fbd78 Filip Navara
                            tmp = neon_load_scratch(unzip_order_q[n]);
5374 dd8fbd78 Filip Navara
                            neon_store_reg(reg, n % 4, tmp);
5375 9ee6e8bb pbrook
                        }
5376 9ee6e8bb pbrook
                    } else {
5377 9ee6e8bb pbrook
                        static int unzip_order[4] =
5378 9ee6e8bb pbrook
                            {0, 4, 1, 5};
5379 9ee6e8bb pbrook
                        for (n = 0; n < 4; n++) {
5380 9ee6e8bb pbrook
                            int reg = (n < 2) ? rd : rm;
5381 dd8fbd78 Filip Navara
                            tmp = neon_load_scratch(unzip_order[n]);
5382 dd8fbd78 Filip Navara
                            neon_store_reg(reg, n % 2, tmp);
5383 9ee6e8bb pbrook
                        }
5384 9ee6e8bb pbrook
                    }
5385 9ee6e8bb pbrook
                    break;
5386 9ee6e8bb pbrook
                case 35: /* VZIP */
5387 9ee6e8bb pbrook
                    /* Reg  Before       After
5388 9ee6e8bb pbrook
                       Rd   A3 A2 A1 A0  B1 A1 B0 A0
5389 9ee6e8bb pbrook
                       Rm   B3 B2 B1 B0  B3 A3 B2 A2
5390 9ee6e8bb pbrook
                     */
5391 9ee6e8bb pbrook
                    if (size == 3)
5392 9ee6e8bb pbrook
                        return 1;
5393 9ee6e8bb pbrook
                    count = (q ? 4 : 2);
5394 9ee6e8bb pbrook
                    for (n = 0; n < count; n++) {
5395 dd8fbd78 Filip Navara
                        tmp = neon_load_reg(rd, n);
5396 dd8fbd78 Filip Navara
                        tmp2 = neon_load_reg(rd, n);
5397 9ee6e8bb pbrook
                        switch (size) {
5398 dd8fbd78 Filip Navara
                        case 0: gen_neon_zip_u8(tmp, tmp2); break;
5399 dd8fbd78 Filip Navara
                        case 1: gen_neon_zip_u16(tmp, tmp2); break;
5400 9ee6e8bb pbrook
                        case 2: /* no-op */; break;
5401 9ee6e8bb pbrook
                        default: abort();
5402 9ee6e8bb pbrook
                        }
5403 dd8fbd78 Filip Navara
                        neon_store_scratch(n * 2, tmp);
5404 dd8fbd78 Filip Navara
                        neon_store_scratch(n * 2 + 1, tmp2);
5405 9ee6e8bb pbrook
                    }
5406 9ee6e8bb pbrook
                    for (n = 0; n < count * 2; n++) {
5407 9ee6e8bb pbrook
                        int reg = (n < count) ? rd : rm;
5408 dd8fbd78 Filip Navara
                        tmp = neon_load_scratch(n);
5409 dd8fbd78 Filip Navara
                        neon_store_reg(reg, n % count, tmp);
5410 9ee6e8bb pbrook
                    }
5411 9ee6e8bb pbrook
                    break;
5412 9ee6e8bb pbrook
                case 36: case 37: /* VMOVN, VQMOVUN, VQMOVN */
5413 ad69471c pbrook
                    if (size == 3)
5414 ad69471c pbrook
                        return 1;
5415 a50f5b91 pbrook
                    TCGV_UNUSED(tmp2);
5416 9ee6e8bb pbrook
                    for (pass = 0; pass < 2; pass++) {
5417 ad69471c pbrook
                        neon_load_reg64(cpu_V0, rm + pass);
5418 ad69471c pbrook
                        tmp = new_tmp();
5419 9ee6e8bb pbrook
                        if (op == 36 && q == 0) {
5420 ad69471c pbrook
                            gen_neon_narrow(size, tmp, cpu_V0);
5421 9ee6e8bb pbrook
                        } else if (q) {
5422 ad69471c pbrook
                            gen_neon_narrow_satu(size, tmp, cpu_V0);
5423 9ee6e8bb pbrook
                        } else {
5424 ad69471c pbrook
                            gen_neon_narrow_sats(size, tmp, cpu_V0);
5425 ad69471c pbrook
                        }
5426 ad69471c pbrook
                        if (pass == 0) {
5427 ad69471c pbrook
                            tmp2 = tmp;
5428 ad69471c pbrook
                        } else {
5429 ad69471c pbrook
                            neon_store_reg(rd, 0, tmp2);
5430 ad69471c pbrook
                            neon_store_reg(rd, 1, tmp);
5431 9ee6e8bb pbrook
                        }
5432 9ee6e8bb pbrook
                    }
5433 9ee6e8bb pbrook
                    break;
5434 9ee6e8bb pbrook
                case 38: /* VSHLL */
5435 ad69471c pbrook
                    if (q || size == 3)
5436 9ee6e8bb pbrook
                        return 1;
5437 ad69471c pbrook
                    tmp = neon_load_reg(rm, 0);
5438 ad69471c pbrook
                    tmp2 = neon_load_reg(rm, 1);
5439 9ee6e8bb pbrook
                    for (pass = 0; pass < 2; pass++) {
5440 ad69471c pbrook
                        if (pass == 1)
5441 ad69471c pbrook
                            tmp = tmp2;
5442 ad69471c pbrook
                        gen_neon_widen(cpu_V0, tmp, size, 1);
5443 ad69471c pbrook
                        neon_store_reg64(cpu_V0, rd + pass);
5444 9ee6e8bb pbrook
                    }
5445 9ee6e8bb pbrook
                    break;
5446 60011498 Paul Brook
                case 44: /* VCVT.F16.F32 */
5447 60011498 Paul Brook
                    if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
5448 60011498 Paul Brook
                      return 1;
5449 60011498 Paul Brook
                    tmp = new_tmp();
5450 60011498 Paul Brook
                    tmp2 = new_tmp();
5451 60011498 Paul Brook
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, 0));
5452 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f32_to_f16(tmp, cpu_F0s, cpu_env);
5453 60011498 Paul Brook
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, 1));
5454 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f32_to_f16(tmp2, cpu_F0s, cpu_env);
5455 60011498 Paul Brook
                    tcg_gen_shli_i32(tmp2, tmp2, 16);
5456 60011498 Paul Brook
                    tcg_gen_or_i32(tmp2, tmp2, tmp);
5457 60011498 Paul Brook
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, 2));
5458 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f32_to_f16(tmp, cpu_F0s, cpu_env);
5459 60011498 Paul Brook
                    tcg_gen_ld_f32(cpu_F0s, cpu_env, neon_reg_offset(rm, 3));
5460 60011498 Paul Brook
                    neon_store_reg(rd, 0, tmp2);
5461 60011498 Paul Brook
                    tmp2 = new_tmp();
5462 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f32_to_f16(tmp2, cpu_F0s, cpu_env);
5463 60011498 Paul Brook
                    tcg_gen_shli_i32(tmp2, tmp2, 16);
5464 60011498 Paul Brook
                    tcg_gen_or_i32(tmp2, tmp2, tmp);
5465 60011498 Paul Brook
                    neon_store_reg(rd, 1, tmp2);
5466 60011498 Paul Brook
                    dead_tmp(tmp);
5467 60011498 Paul Brook
                    break;
5468 60011498 Paul Brook
                case 46: /* VCVT.F32.F16 */
5469 60011498 Paul Brook
                    if (!arm_feature(env, ARM_FEATURE_VFP_FP16))
5470 60011498 Paul Brook
                      return 1;
5471 60011498 Paul Brook
                    tmp3 = new_tmp();
5472 60011498 Paul Brook
                    tmp = neon_load_reg(rm, 0);
5473 60011498 Paul Brook
                    tmp2 = neon_load_reg(rm, 1);
5474 60011498 Paul Brook
                    tcg_gen_ext16u_i32(tmp3, tmp);
5475 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp3, cpu_env);
5476 60011498 Paul Brook
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, 0));
5477 60011498 Paul Brook
                    tcg_gen_shri_i32(tmp3, tmp, 16);
5478 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp3, cpu_env);
5479 60011498 Paul Brook
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, 1));
5480 60011498 Paul Brook
                    dead_tmp(tmp);
5481 60011498 Paul Brook
                    tcg_gen_ext16u_i32(tmp3, tmp2);
5482 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp3, cpu_env);
5483 60011498 Paul Brook
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, 2));
5484 60011498 Paul Brook
                    tcg_gen_shri_i32(tmp3, tmp2, 16);
5485 60011498 Paul Brook
                    gen_helper_vfp_fcvt_f16_to_f32(cpu_F0s, tmp3, cpu_env);
5486 60011498 Paul Brook
                    tcg_gen_st_f32(cpu_F0s, cpu_env, neon_reg_offset(rd, 3));
5487 60011498 Paul Brook
                    dead_tmp(tmp2);
5488 60011498 Paul Brook
                    dead_tmp(tmp3);
5489 60011498 Paul Brook
                    break;
5490 9ee6e8bb pbrook
                default:
5491 9ee6e8bb pbrook
                elementwise:
5492 9ee6e8bb pbrook
                    for (pass = 0; pass < (q ? 4 : 2); pass++) {
5493 9ee6e8bb pbrook
                        if (op == 30 || op == 31 || op >= 58) {
5494 4373f3ce pbrook
                            tcg_gen_ld_f32(cpu_F0s, cpu_env,
5495 4373f3ce pbrook
                                           neon_reg_offset(rm, pass));
5496 dd8fbd78 Filip Navara
                            TCGV_UNUSED(tmp);
5497 9ee6e8bb pbrook
                        } else {
5498 dd8fbd78 Filip Navara
                            tmp = neon_load_reg(rm, pass);
5499 9ee6e8bb pbrook
                        }
5500 9ee6e8bb pbrook
                        switch (op) {
5501 9ee6e8bb pbrook
                        case 1: /* VREV32 */
5502 9ee6e8bb pbrook
                            switch (size) {
5503 dd8fbd78 Filip Navara
                            case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
5504 dd8fbd78 Filip Navara
                            case 1: gen_swap_half(tmp); break;
5505 9ee6e8bb pbrook
                            default: return 1;
5506 9ee6e8bb pbrook
                            }
5507 9ee6e8bb pbrook
                            break;
5508 9ee6e8bb pbrook
                        case 2: /* VREV16 */
5509 9ee6e8bb pbrook
                            if (size != 0)
5510 9ee6e8bb pbrook
                                return 1;
5511 dd8fbd78 Filip Navara
                            gen_rev16(tmp);
5512 9ee6e8bb pbrook
                            break;
5513 9ee6e8bb pbrook
                        case 8: /* CLS */
5514 9ee6e8bb pbrook
                            switch (size) {
5515 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_cls_s8(tmp, tmp); break;
5516 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_cls_s16(tmp, tmp); break;
5517 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_cls_s32(tmp, tmp); break;
5518 9ee6e8bb pbrook
                            default: return 1;
5519 9ee6e8bb pbrook
                            }
5520 9ee6e8bb pbrook
                            break;
5521 9ee6e8bb pbrook
                        case 9: /* CLZ */
5522 9ee6e8bb pbrook
                            switch (size) {
5523 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_clz_u8(tmp, tmp); break;
5524 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_clz_u16(tmp, tmp); break;
5525 dd8fbd78 Filip Navara
                            case 2: gen_helper_clz(tmp, tmp); break;
5526 9ee6e8bb pbrook
                            default: return 1;
5527 9ee6e8bb pbrook
                            }
5528 9ee6e8bb pbrook
                            break;
5529 9ee6e8bb pbrook
                        case 10: /* CNT */
5530 9ee6e8bb pbrook
                            if (size != 0)
5531 9ee6e8bb pbrook
                                return 1;
5532 dd8fbd78 Filip Navara
                            gen_helper_neon_cnt_u8(tmp, tmp);
5533 9ee6e8bb pbrook
                            break;
5534 9ee6e8bb pbrook
                        case 11: /* VNOT */
5535 9ee6e8bb pbrook
                            if (size != 0)
5536 9ee6e8bb pbrook
                                return 1;
5537 dd8fbd78 Filip Navara
                            tcg_gen_not_i32(tmp, tmp);
5538 9ee6e8bb pbrook
                            break;
5539 9ee6e8bb pbrook
                        case 14: /* VQABS */
5540 9ee6e8bb pbrook
                            switch (size) {
5541 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_qabs_s8(tmp, cpu_env, tmp); break;
5542 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_qabs_s16(tmp, cpu_env, tmp); break;
5543 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_qabs_s32(tmp, cpu_env, tmp); break;
5544 9ee6e8bb pbrook
                            default: return 1;
5545 9ee6e8bb pbrook
                            }
5546 9ee6e8bb pbrook
                            break;
5547 9ee6e8bb pbrook
                        case 15: /* VQNEG */
5548 9ee6e8bb pbrook
                            switch (size) {
5549 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_qneg_s8(tmp, cpu_env, tmp); break;
5550 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_qneg_s16(tmp, cpu_env, tmp); break;
5551 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_qneg_s32(tmp, cpu_env, tmp); break;
5552 9ee6e8bb pbrook
                            default: return 1;
5553 9ee6e8bb pbrook
                            }
5554 9ee6e8bb pbrook
                            break;
5555 9ee6e8bb pbrook
                        case 16: case 19: /* VCGT #0, VCLE #0 */
5556 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5557 9ee6e8bb pbrook
                            switch(size) {
5558 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_cgt_s8(tmp, tmp, tmp2); break;
5559 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_cgt_s16(tmp, tmp, tmp2); break;
5560 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_cgt_s32(tmp, tmp, tmp2); break;
5561 9ee6e8bb pbrook
                            default: return 1;
5562 9ee6e8bb pbrook
                            }
5563 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5564 9ee6e8bb pbrook
                            if (op == 19)
5565 dd8fbd78 Filip Navara
                                tcg_gen_not_i32(tmp, tmp);
5566 9ee6e8bb pbrook
                            break;
5567 9ee6e8bb pbrook
                        case 17: case 20: /* VCGE #0, VCLT #0 */
5568 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5569 9ee6e8bb pbrook
                            switch(size) {
5570 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_cge_s8(tmp, tmp, tmp2); break;
5571 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_cge_s16(tmp, tmp, tmp2); break;
5572 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_cge_s32(tmp, tmp, tmp2); break;
5573 9ee6e8bb pbrook
                            default: return 1;
5574 9ee6e8bb pbrook
                            }
5575 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5576 9ee6e8bb pbrook
                            if (op == 20)
5577 dd8fbd78 Filip Navara
                                tcg_gen_not_i32(tmp, tmp);
5578 9ee6e8bb pbrook
                            break;
5579 9ee6e8bb pbrook
                        case 18: /* VCEQ #0 */
5580 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5581 9ee6e8bb pbrook
                            switch(size) {
5582 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_ceq_u8(tmp, tmp, tmp2); break;
5583 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_ceq_u16(tmp, tmp, tmp2); break;
5584 dd8fbd78 Filip Navara
                            case 2: gen_helper_neon_ceq_u32(tmp, tmp, tmp2); break;
5585 9ee6e8bb pbrook
                            default: return 1;
5586 9ee6e8bb pbrook
                            }
5587 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5588 9ee6e8bb pbrook
                            break;
5589 9ee6e8bb pbrook
                        case 22: /* VABS */
5590 9ee6e8bb pbrook
                            switch(size) {
5591 dd8fbd78 Filip Navara
                            case 0: gen_helper_neon_abs_s8(tmp, tmp); break;
5592 dd8fbd78 Filip Navara
                            case 1: gen_helper_neon_abs_s16(tmp, tmp); break;
5593 dd8fbd78 Filip Navara
                            case 2: tcg_gen_abs_i32(tmp, tmp); break;
5594 9ee6e8bb pbrook
                            default: return 1;
5595 9ee6e8bb pbrook
                            }
5596 9ee6e8bb pbrook
                            break;
5597 9ee6e8bb pbrook
                        case 23: /* VNEG */
5598 ad69471c pbrook
                            if (size == 3)
5599 ad69471c pbrook
                                return 1;
5600 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5601 dd8fbd78 Filip Navara
                            gen_neon_rsb(size, tmp, tmp2);
5602 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5603 9ee6e8bb pbrook
                            break;
5604 9ee6e8bb pbrook
                        case 24: case 27: /* Float VCGT #0, Float VCLE #0 */
5605 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5606 dd8fbd78 Filip Navara
                            gen_helper_neon_cgt_f32(tmp, tmp, tmp2);
5607 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5608 9ee6e8bb pbrook
                            if (op == 27)
5609 dd8fbd78 Filip Navara
                                tcg_gen_not_i32(tmp, tmp);
5610 9ee6e8bb pbrook
                            break;
5611 9ee6e8bb pbrook
                        case 25: case 28: /* Float VCGE #0, Float VCLT #0 */
5612 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5613 dd8fbd78 Filip Navara
                            gen_helper_neon_cge_f32(tmp, tmp, tmp2);
5614 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5615 9ee6e8bb pbrook
                            if (op == 28)
5616 dd8fbd78 Filip Navara
                                tcg_gen_not_i32(tmp, tmp);
5617 9ee6e8bb pbrook
                            break;
5618 9ee6e8bb pbrook
                        case 26: /* Float VCEQ #0 */
5619 dd8fbd78 Filip Navara
                            tmp2 = tcg_const_i32(0);
5620 dd8fbd78 Filip Navara
                            gen_helper_neon_ceq_f32(tmp, tmp, tmp2);
5621 dd8fbd78 Filip Navara
                            tcg_temp_free(tmp2);
5622 9ee6e8bb pbrook
                            break;
5623 9ee6e8bb pbrook
                        case 30: /* Float VABS */
5624 4373f3ce pbrook
                            gen_vfp_abs(0);
5625 9ee6e8bb pbrook
                            break;
5626 9ee6e8bb pbrook
                        case 31: /* Float VNEG */
5627 4373f3ce pbrook
                            gen_vfp_neg(0);
5628 9ee6e8bb pbrook
                            break;
5629 9ee6e8bb pbrook
                        case 32: /* VSWP */
5630 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, pass);
5631 dd8fbd78 Filip Navara
                            neon_store_reg(rm, pass, tmp2);
5632 9ee6e8bb pbrook
                            break;
5633 9ee6e8bb pbrook
                        case 33: /* VTRN */
5634 dd8fbd78 Filip Navara
                            tmp2 = neon_load_reg(rd, pass);
5635 9ee6e8bb pbrook
                            switch (size) {
5636 dd8fbd78 Filip Navara
                            case 0: gen_neon_trn_u8(tmp, tmp2); break;
5637 dd8fbd78 Filip Navara
                            case 1: gen_neon_trn_u16(tmp, tmp2); break;
5638 9ee6e8bb pbrook
                            case 2: abort();
5639 9ee6e8bb pbrook
                            default: return 1;
5640 9ee6e8bb pbrook
                            }
5641 dd8fbd78 Filip Navara
                            neon_store_reg(rm, pass, tmp2);
5642 9ee6e8bb pbrook
                            break;
5643 9ee6e8bb pbrook
                        case 56: /* Integer VRECPE */
5644 dd8fbd78 Filip Navara
                            gen_helper_recpe_u32(tmp, tmp, cpu_env);
5645 9ee6e8bb pbrook
                            break;
5646 9ee6e8bb pbrook
                        case 57: /* Integer VRSQRTE */
5647 dd8fbd78 Filip Navara
                            gen_helper_rsqrte_u32(tmp, tmp, cpu_env);
5648 9ee6e8bb pbrook
                            break;
5649 9ee6e8bb pbrook
                        case 58: /* Float VRECPE */
5650 4373f3ce pbrook
                            gen_helper_recpe_f32(cpu_F0s, cpu_F0s, cpu_env);
5651 9ee6e8bb pbrook
                            break;
5652 9ee6e8bb pbrook
                        case 59: /* Float VRSQRTE */
5653 4373f3ce pbrook
                            gen_helper_rsqrte_f32(cpu_F0s, cpu_F0s, cpu_env);
5654 9ee6e8bb pbrook
                            break;
5655 9ee6e8bb pbrook
                        case 60: /* VCVT.F32.S32 */
5656 4373f3ce pbrook
                            gen_vfp_tosiz(0);
5657 9ee6e8bb pbrook
                            break;
5658 9ee6e8bb pbrook
                        case 61: /* VCVT.F32.U32 */
5659 4373f3ce pbrook
                            gen_vfp_touiz(0);
5660 9ee6e8bb pbrook
                            break;
5661 9ee6e8bb pbrook
                        case 62: /* VCVT.S32.F32 */
5662 4373f3ce pbrook
                            gen_vfp_sito(0);
5663 9ee6e8bb pbrook
                            break;
5664 9ee6e8bb pbrook
                        case 63: /* VCVT.U32.F32 */
5665 4373f3ce pbrook
                            gen_vfp_uito(0);
5666 9ee6e8bb pbrook
                            break;
5667 9ee6e8bb pbrook
                        default:
5668 9ee6e8bb pbrook
                            /* Reserved: 21, 29, 39-56 */
5669 9ee6e8bb pbrook
                            return 1;
5670 9ee6e8bb pbrook
                        }
5671 9ee6e8bb pbrook
                        if (op == 30 || op == 31 || op >= 58) {
5672 4373f3ce pbrook
                            tcg_gen_st_f32(cpu_F0s, cpu_env,
5673 4373f3ce pbrook
                                           neon_reg_offset(rd, pass));
5674 9ee6e8bb pbrook
                        } else {
5675 dd8fbd78 Filip Navara
                            neon_store_reg(rd, pass, tmp);
5676 9ee6e8bb pbrook
                        }
5677 9ee6e8bb pbrook
                    }
5678 9ee6e8bb pbrook
                    break;
5679 9ee6e8bb pbrook
                }
5680 9ee6e8bb pbrook
            } else if ((insn & (1 << 10)) == 0) {
5681 9ee6e8bb pbrook
                /* VTBL, VTBX.  */
5682 3018f259 pbrook
                n = ((insn >> 5) & 0x18) + 8;
5683 9ee6e8bb pbrook
                if (insn & (1 << 6)) {
5684 8f8e3aa4 pbrook
                    tmp = neon_load_reg(rd, 0);
5685 9ee6e8bb pbrook
                } else {
5686 8f8e3aa4 pbrook
                    tmp = new_tmp();
5687 8f8e3aa4 pbrook
                    tcg_gen_movi_i32(tmp, 0);
5688 9ee6e8bb pbrook
                }
5689 8f8e3aa4 pbrook
                tmp2 = neon_load_reg(rm, 0);
5690 b75263d6 Juha Riihimรคki
                tmp4 = tcg_const_i32(rn);
5691 b75263d6 Juha Riihimรคki
                tmp5 = tcg_const_i32(n);
5692 b75263d6 Juha Riihimรคki
                gen_helper_neon_tbl(tmp2, tmp2, tmp, tmp4, tmp5);
5693 3018f259 pbrook
                dead_tmp(tmp);
5694 9ee6e8bb pbrook
                if (insn & (1 << 6)) {
5695 8f8e3aa4 pbrook
                    tmp = neon_load_reg(rd, 1);
5696 9ee6e8bb pbrook
                } else {
5697 8f8e3aa4 pbrook
                    tmp = new_tmp();
5698 8f8e3aa4 pbrook
                    tcg_gen_movi_i32(tmp, 0);
5699 9ee6e8bb pbrook
                }
5700 8f8e3aa4 pbrook
                tmp3 = neon_load_reg(rm, 1);
5701 b75263d6 Juha Riihimรคki
                gen_helper_neon_tbl(tmp3, tmp3, tmp, tmp4, tmp5);
5702 25aeb69b Juha Riihimรคki
                tcg_temp_free_i32(tmp5);
5703 25aeb69b Juha Riihimรคki
                tcg_temp_free_i32(tmp4);
5704 8f8e3aa4 pbrook
                neon_store_reg(rd, 0, tmp2);
5705 3018f259 pbrook
                neon_store_reg(rd, 1, tmp3);
5706 3018f259 pbrook
                dead_tmp(tmp);
5707 9ee6e8bb pbrook
            } else if ((insn & 0x380) == 0) {
5708 9ee6e8bb pbrook
                /* VDUP */
5709 9ee6e8bb pbrook
                if (insn & (1 << 19)) {
5710 dd8fbd78 Filip Navara
                    tmp = neon_load_reg(rm, 1);
5711 9ee6e8bb pbrook
                } else {
5712 dd8fbd78 Filip Navara
                    tmp = neon_load_reg(rm, 0);
5713 9ee6e8bb pbrook
                }
5714 9ee6e8bb pbrook
                if (insn & (1 << 16)) {
5715 dd8fbd78 Filip Navara
                    gen_neon_dup_u8(tmp, ((insn >> 17) & 3) * 8);
5716 9ee6e8bb pbrook
                } else if (insn & (1 << 17)) {
5717 9ee6e8bb pbrook
                    if ((insn >> 18) & 1)
5718 dd8fbd78 Filip Navara
                        gen_neon_dup_high16(tmp);
5719 9ee6e8bb pbrook
                    else
5720 dd8fbd78 Filip Navara
                        gen_neon_dup_low16(tmp);
5721 9ee6e8bb pbrook
                }
5722 9ee6e8bb pbrook
                for (pass = 0; pass < (q ? 4 : 2); pass++) {
5723 dd8fbd78 Filip Navara
                    tmp2 = new_tmp();
5724 dd8fbd78 Filip Navara
                    tcg_gen_mov_i32(tmp2, tmp);
5725 dd8fbd78 Filip Navara
                    neon_store_reg(rd, pass, tmp2);
5726 9ee6e8bb pbrook
                }
5727 dd8fbd78 Filip Navara
                dead_tmp(tmp);
5728 9ee6e8bb pbrook
            } else {
5729 9ee6e8bb pbrook
                return 1;
5730 9ee6e8bb pbrook
            }
5731 9ee6e8bb pbrook
        }
5732 9ee6e8bb pbrook
    }
5733 9ee6e8bb pbrook
    return 0;
5734 9ee6e8bb pbrook
}
5735 9ee6e8bb pbrook
5736 fe1479c3 pbrook
static int disas_cp14_read(CPUState * env, DisasContext *s, uint32_t insn)
5737 fe1479c3 pbrook
{
5738 fe1479c3 pbrook
    int crn = (insn >> 16) & 0xf;
5739 fe1479c3 pbrook
    int crm = insn & 0xf;
5740 fe1479c3 pbrook
    int op1 = (insn >> 21) & 7;
5741 fe1479c3 pbrook
    int op2 = (insn >> 5) & 7;
5742 fe1479c3 pbrook
    int rt = (insn >> 12) & 0xf;
5743 fe1479c3 pbrook
    TCGv tmp;
5744 fe1479c3 pbrook
5745 fe1479c3 pbrook
    if (arm_feature(env, ARM_FEATURE_THUMB2EE)) {
5746 fe1479c3 pbrook
        if (op1 == 6 && crn == 0 && crm == 0 && op2 == 0) {
5747 fe1479c3 pbrook
            /* TEECR */
5748 fe1479c3 pbrook
            if (IS_USER(s))
5749 fe1479c3 pbrook
                return 1;
5750 fe1479c3 pbrook
            tmp = load_cpu_field(teecr);
5751 fe1479c3 pbrook
            store_reg(s, rt, tmp);
5752 fe1479c3 pbrook
            return 0;
5753 fe1479c3 pbrook
        }
5754 fe1479c3 pbrook
        if (op1 == 6 && crn == 1 && crm == 0 && op2 == 0) {
5755 fe1479c3 pbrook
            /* TEEHBR */
5756 fe1479c3 pbrook
            if (IS_USER(s) && (env->teecr & 1))
5757 fe1479c3 pbrook
                return 1;
5758 fe1479c3 pbrook
            tmp = load_cpu_field(teehbr);
5759 fe1479c3 pbrook
            store_reg(s, rt, tmp);
5760 fe1479c3 pbrook
            return 0;
5761 fe1479c3 pbrook
        }
5762 fe1479c3 pbrook
    }
5763 fe1479c3 pbrook
    fprintf(stderr, "Unknown cp14 read op1:%d crn:%d crm:%d op2:%d\n",
5764 fe1479c3 pbrook
            op1, crn, crm, op2);
5765 fe1479c3 pbrook
    return 1;
5766 fe1479c3 pbrook
}
5767 fe1479c3 pbrook
5768 fe1479c3 pbrook
static int disas_cp14_write(CPUState * env, DisasContext *s, uint32_t insn)
5769 fe1479c3 pbrook
{
5770 fe1479c3 pbrook
    int crn = (insn >> 16) & 0xf;
5771 fe1479c3 pbrook
    int crm = insn & 0xf;
5772 fe1479c3 pbrook
    int op1 = (insn >> 21) & 7;
5773 fe1479c3 pbrook
    int op2 = (insn >> 5) & 7;
5774 fe1479c3 pbrook
    int rt = (insn >> 12) & 0xf;
5775 fe1479c3 pbrook
    TCGv tmp;
5776 fe1479c3 pbrook
5777 fe1479c3 pbrook
    if (arm_feature(env, ARM_FEATURE_THUMB2EE)) {
5778 fe1479c3 pbrook
        if (op1 == 6 && crn == 0 && crm == 0 && op2 == 0) {
5779 fe1479c3 pbrook
            /* TEECR */
5780 fe1479c3 pbrook
            if (IS_USER(s))
5781 fe1479c3 pbrook
                return 1;
5782 fe1479c3 pbrook
            tmp = load_reg(s, rt);
5783 fe1479c3 pbrook
            gen_helper_set_teecr(cpu_env, tmp);
5784 fe1479c3 pbrook
            dead_tmp(tmp);
5785 fe1479c3 pbrook
            return 0;
5786 fe1479c3 pbrook
        }
5787 fe1479c3 pbrook
        if (op1 == 6 && crn == 1 && crm == 0 && op2 == 0) {
5788 fe1479c3 pbrook
            /* TEEHBR */
5789 fe1479c3 pbrook
            if (IS_USER(s) && (env->teecr & 1))
5790 fe1479c3 pbrook
                return 1;
5791 fe1479c3 pbrook
            tmp = load_reg(s, rt);
5792 fe1479c3 pbrook
            store_cpu_field(tmp, teehbr);
5793 fe1479c3 pbrook
            return 0;
5794 fe1479c3 pbrook
        }
5795 fe1479c3 pbrook
    }
5796 fe1479c3 pbrook
    fprintf(stderr, "Unknown cp14 write op1:%d crn:%d crm:%d op2:%d\n",
5797 fe1479c3 pbrook
            op1, crn, crm, op2);
5798 fe1479c3 pbrook
    return 1;
5799 fe1479c3 pbrook
}
5800 fe1479c3 pbrook
5801 9ee6e8bb pbrook
static int disas_coproc_insn(CPUState * env, DisasContext *s, uint32_t insn)
5802 9ee6e8bb pbrook
{
5803 9ee6e8bb pbrook
    int cpnum;
5804 9ee6e8bb pbrook
5805 9ee6e8bb pbrook
    cpnum = (insn >> 8) & 0xf;
5806 9ee6e8bb pbrook
    if (arm_feature(env, ARM_FEATURE_XSCALE)
5807 9ee6e8bb pbrook
            && ((env->cp15.c15_cpar ^ 0x3fff) & (1 << cpnum)))
5808 9ee6e8bb pbrook
        return 1;
5809 9ee6e8bb pbrook
5810 9ee6e8bb pbrook
    switch (cpnum) {
5811 9ee6e8bb pbrook
      case 0:
5812 9ee6e8bb pbrook
      case 1:
5813 9ee6e8bb pbrook
        if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
5814 9ee6e8bb pbrook
            return disas_iwmmxt_insn(env, s, insn);
5815 9ee6e8bb pbrook
        } else if (arm_feature(env, ARM_FEATURE_XSCALE)) {
5816 9ee6e8bb pbrook
            return disas_dsp_insn(env, s, insn);
5817 9ee6e8bb pbrook
        }
5818 9ee6e8bb pbrook
        return 1;
5819 9ee6e8bb pbrook
    case 10:
5820 9ee6e8bb pbrook
    case 11:
5821 9ee6e8bb pbrook
        return disas_vfp_insn (env, s, insn);
5822 fe1479c3 pbrook
    case 14:
5823 fe1479c3 pbrook
        /* Coprocessors 7-15 are architecturally reserved by ARM.
5824 fe1479c3 pbrook
           Unfortunately Intel decided to ignore this.  */
5825 fe1479c3 pbrook
        if (arm_feature(env, ARM_FEATURE_XSCALE))
5826 fe1479c3 pbrook
            goto board;
5827 fe1479c3 pbrook
        if (insn & (1 << 20))
5828 fe1479c3 pbrook
            return disas_cp14_read(env, s, insn);
5829 fe1479c3 pbrook
        else
5830 fe1479c3 pbrook
            return disas_cp14_write(env, s, insn);
5831 9ee6e8bb pbrook
    case 15:
5832 9ee6e8bb pbrook
        return disas_cp15_insn (env, s, insn);
5833 9ee6e8bb pbrook
    default:
5834 fe1479c3 pbrook
    board:
5835 9ee6e8bb pbrook
        /* Unknown coprocessor.  See if the board has hooked it.  */
5836 9ee6e8bb pbrook
        return disas_cp_insn (env, s, insn);
5837 9ee6e8bb pbrook
    }
5838 9ee6e8bb pbrook
}
5839 9ee6e8bb pbrook
5840 5e3f878a pbrook
5841 5e3f878a pbrook
/* Store a 64-bit value to a register pair.  Clobbers val.  */
5842 a7812ae4 pbrook
static void gen_storeq_reg(DisasContext *s, int rlow, int rhigh, TCGv_i64 val)
5843 5e3f878a pbrook
{
5844 5e3f878a pbrook
    TCGv tmp;
5845 5e3f878a pbrook
    tmp = new_tmp();
5846 5e3f878a pbrook
    tcg_gen_trunc_i64_i32(tmp, val);
5847 5e3f878a pbrook
    store_reg(s, rlow, tmp);
5848 5e3f878a pbrook
    tmp = new_tmp();
5849 5e3f878a pbrook
    tcg_gen_shri_i64(val, val, 32);
5850 5e3f878a pbrook
    tcg_gen_trunc_i64_i32(tmp, val);
5851 5e3f878a pbrook
    store_reg(s, rhigh, tmp);
5852 5e3f878a pbrook
}
5853 5e3f878a pbrook
5854 5e3f878a pbrook
/* load a 32-bit value from a register and perform a 64-bit accumulate.  */
5855 a7812ae4 pbrook
static void gen_addq_lo(DisasContext *s, TCGv_i64 val, int rlow)
5856 5e3f878a pbrook
{
5857 a7812ae4 pbrook
    TCGv_i64 tmp;
5858 5e3f878a pbrook
    TCGv tmp2;
5859 5e3f878a pbrook
5860 36aa55dc pbrook
    /* Load value and extend to 64 bits.  */
5861 a7812ae4 pbrook
    tmp = tcg_temp_new_i64();
5862 5e3f878a pbrook
    tmp2 = load_reg(s, rlow);
5863 5e3f878a pbrook
    tcg_gen_extu_i32_i64(tmp, tmp2);
5864 5e3f878a pbrook
    dead_tmp(tmp2);
5865 5e3f878a pbrook
    tcg_gen_add_i64(val, val, tmp);
5866 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp);
5867 5e3f878a pbrook
}
5868 5e3f878a pbrook
5869 5e3f878a pbrook
/* load and add a 64-bit value from a register pair.  */
5870 a7812ae4 pbrook
static void gen_addq(DisasContext *s, TCGv_i64 val, int rlow, int rhigh)
5871 5e3f878a pbrook
{
5872 a7812ae4 pbrook
    TCGv_i64 tmp;
5873 36aa55dc pbrook
    TCGv tmpl;
5874 36aa55dc pbrook
    TCGv tmph;
5875 5e3f878a pbrook
5876 5e3f878a pbrook
    /* Load 64-bit value rd:rn.  */
5877 36aa55dc pbrook
    tmpl = load_reg(s, rlow);
5878 36aa55dc pbrook
    tmph = load_reg(s, rhigh);
5879 a7812ae4 pbrook
    tmp = tcg_temp_new_i64();
5880 36aa55dc pbrook
    tcg_gen_concat_i32_i64(tmp, tmpl, tmph);
5881 36aa55dc pbrook
    dead_tmp(tmpl);
5882 36aa55dc pbrook
    dead_tmp(tmph);
5883 5e3f878a pbrook
    tcg_gen_add_i64(val, val, tmp);
5884 b75263d6 Juha Riihimรคki
    tcg_temp_free_i64(tmp);
5885 5e3f878a pbrook
}
5886 5e3f878a pbrook
5887 5e3f878a pbrook
/* Set N and Z flags from a 64-bit value.  */
5888 a7812ae4 pbrook
static void gen_logicq_cc(TCGv_i64 val)
5889 5e3f878a pbrook
{
5890 5e3f878a pbrook
    TCGv tmp = new_tmp();
5891 5e3f878a pbrook
    gen_helper_logicq_cc(tmp, val);
5892 6fbe23d5 pbrook
    gen_logic_CC(tmp);
5893 6fbe23d5 pbrook
    dead_tmp(tmp);
5894 5e3f878a pbrook
}
5895 5e3f878a pbrook
5896 426f5abc Paul Brook
/* Load/Store exclusive instructions are implemented by remembering
5897 426f5abc Paul Brook
   the value/address loaded, and seeing if these are the same
5898 426f5abc Paul Brook
   when the store is performed. This should be is sufficient to implement
5899 426f5abc Paul Brook
   the architecturally mandated semantics, and avoids having to monitor
5900 426f5abc Paul Brook
   regular stores.
5901 426f5abc Paul Brook

5902 426f5abc Paul Brook
   In system emulation mode only one CPU will be running at once, so
5903 426f5abc Paul Brook
   this sequence is effectively atomic.  In user emulation mode we
5904 426f5abc Paul Brook
   throw an exception and handle the atomic operation elsewhere.  */
5905 426f5abc Paul Brook
static void gen_load_exclusive(DisasContext *s, int rt, int rt2,
5906 426f5abc Paul Brook
                               TCGv addr, int size)
5907 426f5abc Paul Brook
{
5908 426f5abc Paul Brook
    TCGv tmp;
5909 426f5abc Paul Brook
5910 426f5abc Paul Brook
    switch (size) {
5911 426f5abc Paul Brook
    case 0:
5912 426f5abc Paul Brook
        tmp = gen_ld8u(addr, IS_USER(s));
5913 426f5abc Paul Brook
        break;
5914 426f5abc Paul Brook
    case 1:
5915 426f5abc Paul Brook
        tmp = gen_ld16u(addr, IS_USER(s));
5916 426f5abc Paul Brook
        break;
5917 426f5abc Paul Brook
    case 2:
5918 426f5abc Paul Brook
    case 3:
5919 426f5abc Paul Brook
        tmp = gen_ld32(addr, IS_USER(s));
5920 426f5abc Paul Brook
        break;
5921 426f5abc Paul Brook
    default:
5922 426f5abc Paul Brook
        abort();
5923 426f5abc Paul Brook
    }
5924 426f5abc Paul Brook
    tcg_gen_mov_i32(cpu_exclusive_val, tmp);
5925 426f5abc Paul Brook
    store_reg(s, rt, tmp);
5926 426f5abc Paul Brook
    if (size == 3) {
5927 426f5abc Paul Brook
        tcg_gen_addi_i32(addr, addr, 4);
5928 426f5abc Paul Brook
        tmp = gen_ld32(addr, IS_USER(s));
5929 426f5abc Paul Brook
        tcg_gen_mov_i32(cpu_exclusive_high, tmp);
5930 426f5abc Paul Brook
        store_reg(s, rt2, tmp);
5931 426f5abc Paul Brook
    }
5932 426f5abc Paul Brook
    tcg_gen_mov_i32(cpu_exclusive_addr, addr);
5933 426f5abc Paul Brook
}
5934 426f5abc Paul Brook
5935 426f5abc Paul Brook
static void gen_clrex(DisasContext *s)
5936 426f5abc Paul Brook
{
5937 426f5abc Paul Brook
    tcg_gen_movi_i32(cpu_exclusive_addr, -1);
5938 426f5abc Paul Brook
}
5939 426f5abc Paul Brook
5940 426f5abc Paul Brook
#ifdef CONFIG_USER_ONLY
5941 426f5abc Paul Brook
static void gen_store_exclusive(DisasContext *s, int rd, int rt, int rt2,
5942 426f5abc Paul Brook
                                TCGv addr, int size)
5943 426f5abc Paul Brook
{
5944 426f5abc Paul Brook
    tcg_gen_mov_i32(cpu_exclusive_test, addr);
5945 426f5abc Paul Brook
    tcg_gen_movi_i32(cpu_exclusive_info,
5946 426f5abc Paul Brook
                     size | (rd << 4) | (rt << 8) | (rt2 << 12));
5947 426f5abc Paul Brook
    gen_set_condexec(s);
5948 426f5abc Paul Brook
    gen_set_pc_im(s->pc - 4);
5949 426f5abc Paul Brook
    gen_exception(EXCP_STREX);
5950 426f5abc Paul Brook
    s->is_jmp = DISAS_JUMP;
5951 426f5abc Paul Brook
}
5952 426f5abc Paul Brook
#else
5953 426f5abc Paul Brook
static void gen_store_exclusive(DisasContext *s, int rd, int rt, int rt2,
5954 426f5abc Paul Brook
                                TCGv addr, int size)
5955 426f5abc Paul Brook
{
5956 426f5abc Paul Brook
    TCGv tmp;
5957 426f5abc Paul Brook
    int done_label;
5958 426f5abc Paul Brook
    int fail_label;
5959 426f5abc Paul Brook
5960 426f5abc Paul Brook
    /* if (env->exclusive_addr == addr && env->exclusive_val == [addr]) {
5961 426f5abc Paul Brook
         [addr] = {Rt};
5962 426f5abc Paul Brook
         {Rd} = 0;
5963 426f5abc Paul Brook
       } else {
5964 426f5abc Paul Brook
         {Rd} = 1;
5965 426f5abc Paul Brook
       } */
5966 426f5abc Paul Brook
    fail_label = gen_new_label();
5967 426f5abc Paul Brook
    done_label = gen_new_label();
5968 426f5abc Paul Brook
    tcg_gen_brcond_i32(TCG_COND_NE, addr, cpu_exclusive_addr, fail_label);
5969 426f5abc Paul Brook
    switch (size) {
5970 426f5abc Paul Brook
    case 0:
5971 426f5abc Paul Brook
        tmp = gen_ld8u(addr, IS_USER(s));
5972 426f5abc Paul Brook
        break;
5973 426f5abc Paul Brook
    case 1:
5974 426f5abc Paul Brook
        tmp = gen_ld16u(addr, IS_USER(s));
5975 426f5abc Paul Brook
        break;
5976 426f5abc Paul Brook
    case 2:
5977 426f5abc Paul Brook
    case 3:
5978 426f5abc Paul Brook
        tmp = gen_ld32(addr, IS_USER(s));
5979 426f5abc Paul Brook
        break;
5980 426f5abc Paul Brook
    default:
5981 426f5abc Paul Brook
        abort();
5982 426f5abc Paul Brook
    }
5983 426f5abc Paul Brook
    tcg_gen_brcond_i32(TCG_COND_NE, tmp, cpu_exclusive_val, fail_label);
5984 426f5abc Paul Brook
    dead_tmp(tmp);
5985 426f5abc Paul Brook
    if (size == 3) {
5986 426f5abc Paul Brook
        TCGv tmp2 = new_tmp();
5987 426f5abc Paul Brook
        tcg_gen_addi_i32(tmp2, addr, 4);
5988 426f5abc Paul Brook
        tmp = gen_ld32(addr, IS_USER(s));
5989 426f5abc Paul Brook
        dead_tmp(tmp2);
5990 426f5abc Paul Brook
        tcg_gen_brcond_i32(TCG_COND_NE, tmp, cpu_exclusive_high, fail_label);
5991 426f5abc Paul Brook
        dead_tmp(tmp);
5992 426f5abc Paul Brook
    }
5993 426f5abc Paul Brook
    tmp = load_reg(s, rt);
5994 426f5abc Paul Brook
    switch (size) {
5995 426f5abc Paul Brook
    case 0:
5996 426f5abc Paul Brook
        gen_st8(tmp, addr, IS_USER(s));
5997 426f5abc Paul Brook
        break;
5998 426f5abc Paul Brook
    case 1:
5999 426f5abc Paul Brook
        gen_st16(tmp, addr, IS_USER(s));
6000 426f5abc Paul Brook
        break;
6001 426f5abc Paul Brook
    case 2:
6002 426f5abc Paul Brook
    case 3:
6003 426f5abc Paul Brook
        gen_st32(tmp, addr, IS_USER(s));
6004 426f5abc Paul Brook
        break;
6005 426f5abc Paul Brook
    default:
6006 426f5abc Paul Brook
        abort();
6007 426f5abc Paul Brook
    }
6008 426f5abc Paul Brook
    if (size == 3) {
6009 426f5abc Paul Brook
        tcg_gen_addi_i32(addr, addr, 4);
6010 426f5abc Paul Brook
        tmp = load_reg(s, rt2);
6011 426f5abc Paul Brook
        gen_st32(tmp, addr, IS_USER(s));
6012 426f5abc Paul Brook
    }
6013 426f5abc Paul Brook
    tcg_gen_movi_i32(cpu_R[rd], 0);
6014 426f5abc Paul Brook
    tcg_gen_br(done_label);
6015 426f5abc Paul Brook
    gen_set_label(fail_label);
6016 426f5abc Paul Brook
    tcg_gen_movi_i32(cpu_R[rd], 1);
6017 426f5abc Paul Brook
    gen_set_label(done_label);
6018 426f5abc Paul Brook
    tcg_gen_movi_i32(cpu_exclusive_addr, -1);
6019 426f5abc Paul Brook
}
6020 426f5abc Paul Brook
#endif
6021 426f5abc Paul Brook
6022 9ee6e8bb pbrook
static void disas_arm_insn(CPUState * env, DisasContext *s)
6023 9ee6e8bb pbrook
{
6024 9ee6e8bb pbrook
    unsigned int cond, insn, val, op1, i, shift, rm, rs, rn, rd, sh;
6025 b26eefb6 pbrook
    TCGv tmp;
6026 3670669c pbrook
    TCGv tmp2;
6027 6ddbc6e4 pbrook
    TCGv tmp3;
6028 b0109805 pbrook
    TCGv addr;
6029 a7812ae4 pbrook
    TCGv_i64 tmp64;
6030 9ee6e8bb pbrook
6031 9ee6e8bb pbrook
    insn = ldl_code(s->pc);
6032 9ee6e8bb pbrook
    s->pc += 4;
6033 9ee6e8bb pbrook
6034 9ee6e8bb pbrook
    /* M variants do not implement ARM mode.  */
6035 9ee6e8bb pbrook
    if (IS_M(env))
6036 9ee6e8bb pbrook
        goto illegal_op;
6037 9ee6e8bb pbrook
    cond = insn >> 28;
6038 9ee6e8bb pbrook
    if (cond == 0xf){
6039 9ee6e8bb pbrook
        /* Unconditional instructions.  */
6040 9ee6e8bb pbrook
        if (((insn >> 25) & 7) == 1) {
6041 9ee6e8bb pbrook
            /* NEON Data processing.  */
6042 9ee6e8bb pbrook
            if (!arm_feature(env, ARM_FEATURE_NEON))
6043 9ee6e8bb pbrook
                goto illegal_op;
6044 9ee6e8bb pbrook
6045 9ee6e8bb pbrook
            if (disas_neon_data_insn(env, s, insn))
6046 9ee6e8bb pbrook
                goto illegal_op;
6047 9ee6e8bb pbrook
            return;
6048 9ee6e8bb pbrook
        }
6049 9ee6e8bb pbrook
        if ((insn & 0x0f100000) == 0x04000000) {
6050 9ee6e8bb pbrook
            /* NEON load/store.  */
6051 9ee6e8bb pbrook
            if (!arm_feature(env, ARM_FEATURE_NEON))
6052 9ee6e8bb pbrook
                goto illegal_op;
6053 9ee6e8bb pbrook
6054 9ee6e8bb pbrook
            if (disas_neon_ls_insn(env, s, insn))
6055 9ee6e8bb pbrook
                goto illegal_op;
6056 9ee6e8bb pbrook
            return;
6057 9ee6e8bb pbrook
        }
6058 9ee6e8bb pbrook
        if ((insn & 0x0d70f000) == 0x0550f000)
6059 9ee6e8bb pbrook
            return; /* PLD */
6060 9ee6e8bb pbrook
        else if ((insn & 0x0ffffdff) == 0x01010000) {
6061 9ee6e8bb pbrook
            ARCH(6);
6062 9ee6e8bb pbrook
            /* setend */
6063 9ee6e8bb pbrook
            if (insn & (1 << 9)) {
6064 9ee6e8bb pbrook
                /* BE8 mode not implemented.  */
6065 9ee6e8bb pbrook
                goto illegal_op;
6066 9ee6e8bb pbrook
            }
6067 9ee6e8bb pbrook
            return;
6068 9ee6e8bb pbrook
        } else if ((insn & 0x0fffff00) == 0x057ff000) {
6069 9ee6e8bb pbrook
            switch ((insn >> 4) & 0xf) {
6070 9ee6e8bb pbrook
            case 1: /* clrex */
6071 9ee6e8bb pbrook
                ARCH(6K);
6072 426f5abc Paul Brook
                gen_clrex(s);
6073 9ee6e8bb pbrook
                return;
6074 9ee6e8bb pbrook
            case 4: /* dsb */
6075 9ee6e8bb pbrook
            case 5: /* dmb */
6076 9ee6e8bb pbrook
            case 6: /* isb */
6077 9ee6e8bb pbrook
                ARCH(7);
6078 9ee6e8bb pbrook
                /* We don't emulate caches so these are a no-op.  */
6079 9ee6e8bb pbrook
                return;
6080 9ee6e8bb pbrook
            default:
6081 9ee6e8bb pbrook
                goto illegal_op;
6082 9ee6e8bb pbrook
            }
6083 9ee6e8bb pbrook
        } else if ((insn & 0x0e5fffe0) == 0x084d0500) {
6084 9ee6e8bb pbrook
            /* srs */
6085 c67b6b71 Filip Navara
            int32_t offset;
6086 9ee6e8bb pbrook
            if (IS_USER(s))
6087 9ee6e8bb pbrook
                goto illegal_op;
6088 9ee6e8bb pbrook
            ARCH(6);
6089 9ee6e8bb pbrook
            op1 = (insn & 0x1f);
6090 9ee6e8bb pbrook
            if (op1 == (env->uncached_cpsr & CPSR_M)) {
6091 b0109805 pbrook
                addr = load_reg(s, 13);
6092 9ee6e8bb pbrook
            } else {
6093 b0109805 pbrook
                addr = new_tmp();
6094 b75263d6 Juha Riihimรคki
                tmp = tcg_const_i32(op1);
6095 b75263d6 Juha Riihimรคki
                gen_helper_get_r13_banked(addr, cpu_env, tmp);
6096 b75263d6 Juha Riihimรคki
                tcg_temp_free_i32(tmp);
6097 9ee6e8bb pbrook
            }
6098 9ee6e8bb pbrook
            i = (insn >> 23) & 3;
6099 9ee6e8bb pbrook
            switch (i) {
6100 9ee6e8bb pbrook
            case 0: offset = -4; break; /* DA */
6101 c67b6b71 Filip Navara
            case 1: offset = 0; break; /* IA */
6102 c67b6b71 Filip Navara
            case 2: offset = -8; break; /* DB */
6103 9ee6e8bb pbrook
            case 3: offset = 4; break; /* IB */
6104 9ee6e8bb pbrook
            default: abort();
6105 9ee6e8bb pbrook
            }
6106 9ee6e8bb pbrook
            if (offset)
6107 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, offset);
6108 b0109805 pbrook
            tmp = load_reg(s, 14);
6109 b0109805 pbrook
            gen_st32(tmp, addr, 0);
6110 c67b6b71 Filip Navara
            tmp = load_cpu_field(spsr);
6111 b0109805 pbrook
            tcg_gen_addi_i32(addr, addr, 4);
6112 b0109805 pbrook
            gen_st32(tmp, addr, 0);
6113 9ee6e8bb pbrook
            if (insn & (1 << 21)) {
6114 9ee6e8bb pbrook
                /* Base writeback.  */
6115 9ee6e8bb pbrook
                switch (i) {
6116 9ee6e8bb pbrook
                case 0: offset = -8; break;
6117 c67b6b71 Filip Navara
                case 1: offset = 4; break;
6118 c67b6b71 Filip Navara
                case 2: offset = -4; break;
6119 9ee6e8bb pbrook
                case 3: offset = 0; break;
6120 9ee6e8bb pbrook
                default: abort();
6121 9ee6e8bb pbrook
                }
6122 9ee6e8bb pbrook
                if (offset)
6123 c67b6b71 Filip Navara
                    tcg_gen_addi_i32(addr, addr, offset);
6124 9ee6e8bb pbrook
                if (op1 == (env->uncached_cpsr & CPSR_M)) {
6125 c67b6b71 Filip Navara
                    store_reg(s, 13, addr);
6126 9ee6e8bb pbrook
                } else {
6127 b75263d6 Juha Riihimรคki
                    tmp = tcg_const_i32(op1);
6128 b75263d6 Juha Riihimรคki
                    gen_helper_set_r13_banked(cpu_env, tmp, addr);
6129 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i32(tmp);
6130 c67b6b71 Filip Navara
                    dead_tmp(addr);
6131 9ee6e8bb pbrook
                }
6132 b0109805 pbrook
            } else {
6133 b0109805 pbrook
                dead_tmp(addr);
6134 9ee6e8bb pbrook
            }
6135 9ee6e8bb pbrook
        } else if ((insn & 0x0e5fffe0) == 0x081d0a00) {
6136 9ee6e8bb pbrook
            /* rfe */
6137 c67b6b71 Filip Navara
            int32_t offset;
6138 9ee6e8bb pbrook
            if (IS_USER(s))
6139 9ee6e8bb pbrook
                goto illegal_op;
6140 9ee6e8bb pbrook
            ARCH(6);
6141 9ee6e8bb pbrook
            rn = (insn >> 16) & 0xf;
6142 b0109805 pbrook
            addr = load_reg(s, rn);
6143 9ee6e8bb pbrook
            i = (insn >> 23) & 3;
6144 9ee6e8bb pbrook
            switch (i) {
6145 b0109805 pbrook
            case 0: offset = -4; break; /* DA */
6146 c67b6b71 Filip Navara
            case 1: offset = 0; break; /* IA */
6147 c67b6b71 Filip Navara
            case 2: offset = -8; break; /* DB */
6148 b0109805 pbrook
            case 3: offset = 4; break; /* IB */
6149 9ee6e8bb pbrook
            default: abort();
6150 9ee6e8bb pbrook
            }
6151 9ee6e8bb pbrook
            if (offset)
6152 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, offset);
6153 b0109805 pbrook
            /* Load PC into tmp and CPSR into tmp2.  */
6154 b0109805 pbrook
            tmp = gen_ld32(addr, 0);
6155 b0109805 pbrook
            tcg_gen_addi_i32(addr, addr, 4);
6156 b0109805 pbrook
            tmp2 = gen_ld32(addr, 0);
6157 9ee6e8bb pbrook
            if (insn & (1 << 21)) {
6158 9ee6e8bb pbrook
                /* Base writeback.  */
6159 9ee6e8bb pbrook
                switch (i) {
6160 b0109805 pbrook
                case 0: offset = -8; break;
6161 c67b6b71 Filip Navara
                case 1: offset = 4; break;
6162 c67b6b71 Filip Navara
                case 2: offset = -4; break;
6163 b0109805 pbrook
                case 3: offset = 0; break;
6164 9ee6e8bb pbrook
                default: abort();
6165 9ee6e8bb pbrook
                }
6166 9ee6e8bb pbrook
                if (offset)
6167 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, offset);
6168 b0109805 pbrook
                store_reg(s, rn, addr);
6169 b0109805 pbrook
            } else {
6170 b0109805 pbrook
                dead_tmp(addr);
6171 9ee6e8bb pbrook
            }
6172 b0109805 pbrook
            gen_rfe(s, tmp, tmp2);
6173 c67b6b71 Filip Navara
            return;
6174 9ee6e8bb pbrook
        } else if ((insn & 0x0e000000) == 0x0a000000) {
6175 9ee6e8bb pbrook
            /* branch link and change to thumb (blx <offset>) */
6176 9ee6e8bb pbrook
            int32_t offset;
6177 9ee6e8bb pbrook
6178 9ee6e8bb pbrook
            val = (uint32_t)s->pc;
6179 d9ba4830 pbrook
            tmp = new_tmp();
6180 d9ba4830 pbrook
            tcg_gen_movi_i32(tmp, val);
6181 d9ba4830 pbrook
            store_reg(s, 14, tmp);
6182 9ee6e8bb pbrook
            /* Sign-extend the 24-bit offset */
6183 9ee6e8bb pbrook
            offset = (((int32_t)insn) << 8) >> 8;
6184 9ee6e8bb pbrook
            /* offset * 4 + bit24 * 2 + (thumb bit) */
6185 9ee6e8bb pbrook
            val += (offset << 2) | ((insn >> 23) & 2) | 1;
6186 9ee6e8bb pbrook
            /* pipeline offset */
6187 9ee6e8bb pbrook
            val += 4;
6188 d9ba4830 pbrook
            gen_bx_im(s, val);
6189 9ee6e8bb pbrook
            return;
6190 9ee6e8bb pbrook
        } else if ((insn & 0x0e000f00) == 0x0c000100) {
6191 9ee6e8bb pbrook
            if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
6192 9ee6e8bb pbrook
                /* iWMMXt register transfer.  */
6193 9ee6e8bb pbrook
                if (env->cp15.c15_cpar & (1 << 1))
6194 9ee6e8bb pbrook
                    if (!disas_iwmmxt_insn(env, s, insn))
6195 9ee6e8bb pbrook
                        return;
6196 9ee6e8bb pbrook
            }
6197 9ee6e8bb pbrook
        } else if ((insn & 0x0fe00000) == 0x0c400000) {
6198 9ee6e8bb pbrook
            /* Coprocessor double register transfer.  */
6199 9ee6e8bb pbrook
        } else if ((insn & 0x0f000010) == 0x0e000010) {
6200 9ee6e8bb pbrook
            /* Additional coprocessor register transfer.  */
6201 7997d92f balrog
        } else if ((insn & 0x0ff10020) == 0x01000000) {
6202 9ee6e8bb pbrook
            uint32_t mask;
6203 9ee6e8bb pbrook
            uint32_t val;
6204 9ee6e8bb pbrook
            /* cps (privileged) */
6205 9ee6e8bb pbrook
            if (IS_USER(s))
6206 9ee6e8bb pbrook
                return;
6207 9ee6e8bb pbrook
            mask = val = 0;
6208 9ee6e8bb pbrook
            if (insn & (1 << 19)) {
6209 9ee6e8bb pbrook
                if (insn & (1 << 8))
6210 9ee6e8bb pbrook
                    mask |= CPSR_A;
6211 9ee6e8bb pbrook
                if (insn & (1 << 7))
6212 9ee6e8bb pbrook
                    mask |= CPSR_I;
6213 9ee6e8bb pbrook
                if (insn & (1 << 6))
6214 9ee6e8bb pbrook
                    mask |= CPSR_F;
6215 9ee6e8bb pbrook
                if (insn & (1 << 18))
6216 9ee6e8bb pbrook
                    val |= mask;
6217 9ee6e8bb pbrook
            }
6218 7997d92f balrog
            if (insn & (1 << 17)) {
6219 9ee6e8bb pbrook
                mask |= CPSR_M;
6220 9ee6e8bb pbrook
                val |= (insn & 0x1f);
6221 9ee6e8bb pbrook
            }
6222 9ee6e8bb pbrook
            if (mask) {
6223 2fbac54b Filip Navara
                gen_set_psr_im(s, mask, 0, val);
6224 9ee6e8bb pbrook
            }
6225 9ee6e8bb pbrook
            return;
6226 9ee6e8bb pbrook
        }
6227 9ee6e8bb pbrook
        goto illegal_op;
6228 9ee6e8bb pbrook
    }
6229 9ee6e8bb pbrook
    if (cond != 0xe) {
6230 9ee6e8bb pbrook
        /* if not always execute, we generate a conditional jump to
6231 9ee6e8bb pbrook
           next instruction */
6232 9ee6e8bb pbrook
        s->condlabel = gen_new_label();
6233 d9ba4830 pbrook
        gen_test_cc(cond ^ 1, s->condlabel);
6234 9ee6e8bb pbrook
        s->condjmp = 1;
6235 9ee6e8bb pbrook
    }
6236 9ee6e8bb pbrook
    if ((insn & 0x0f900000) == 0x03000000) {
6237 9ee6e8bb pbrook
        if ((insn & (1 << 21)) == 0) {
6238 9ee6e8bb pbrook
            ARCH(6T2);
6239 9ee6e8bb pbrook
            rd = (insn >> 12) & 0xf;
6240 9ee6e8bb pbrook
            val = ((insn >> 4) & 0xf000) | (insn & 0xfff);
6241 9ee6e8bb pbrook
            if ((insn & (1 << 22)) == 0) {
6242 9ee6e8bb pbrook
                /* MOVW */
6243 5e3f878a pbrook
                tmp = new_tmp();
6244 5e3f878a pbrook
                tcg_gen_movi_i32(tmp, val);
6245 9ee6e8bb pbrook
            } else {
6246 9ee6e8bb pbrook
                /* MOVT */
6247 5e3f878a pbrook
                tmp = load_reg(s, rd);
6248 86831435 pbrook
                tcg_gen_ext16u_i32(tmp, tmp);
6249 5e3f878a pbrook
                tcg_gen_ori_i32(tmp, tmp, val << 16);
6250 9ee6e8bb pbrook
            }
6251 5e3f878a pbrook
            store_reg(s, rd, tmp);
6252 9ee6e8bb pbrook
        } else {
6253 9ee6e8bb pbrook
            if (((insn >> 12) & 0xf) != 0xf)
6254 9ee6e8bb pbrook
                goto illegal_op;
6255 9ee6e8bb pbrook
            if (((insn >> 16) & 0xf) == 0) {
6256 9ee6e8bb pbrook
                gen_nop_hint(s, insn & 0xff);
6257 9ee6e8bb pbrook
            } else {
6258 9ee6e8bb pbrook
                /* CPSR = immediate */
6259 9ee6e8bb pbrook
                val = insn & 0xff;
6260 9ee6e8bb pbrook
                shift = ((insn >> 8) & 0xf) * 2;
6261 9ee6e8bb pbrook
                if (shift)
6262 9ee6e8bb pbrook
                    val = (val >> shift) | (val << (32 - shift));
6263 9ee6e8bb pbrook
                i = ((insn & (1 << 22)) != 0);
6264 2fbac54b Filip Navara
                if (gen_set_psr_im(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, val))
6265 9ee6e8bb pbrook
                    goto illegal_op;
6266 9ee6e8bb pbrook
            }
6267 9ee6e8bb pbrook
        }
6268 9ee6e8bb pbrook
    } else if ((insn & 0x0f900000) == 0x01000000
6269 9ee6e8bb pbrook
               && (insn & 0x00000090) != 0x00000090) {
6270 9ee6e8bb pbrook
        /* miscellaneous instructions */
6271 9ee6e8bb pbrook
        op1 = (insn >> 21) & 3;
6272 9ee6e8bb pbrook
        sh = (insn >> 4) & 0xf;
6273 9ee6e8bb pbrook
        rm = insn & 0xf;
6274 9ee6e8bb pbrook
        switch (sh) {
6275 9ee6e8bb pbrook
        case 0x0: /* move program status register */
6276 9ee6e8bb pbrook
            if (op1 & 1) {
6277 9ee6e8bb pbrook
                /* PSR = reg */
6278 2fbac54b Filip Navara
                tmp = load_reg(s, rm);
6279 9ee6e8bb pbrook
                i = ((op1 & 2) != 0);
6280 2fbac54b Filip Navara
                if (gen_set_psr(s, msr_mask(env, s, (insn >> 16) & 0xf, i), i, tmp))
6281 9ee6e8bb pbrook
                    goto illegal_op;
6282 9ee6e8bb pbrook
            } else {
6283 9ee6e8bb pbrook
                /* reg = PSR */
6284 9ee6e8bb pbrook
                rd = (insn >> 12) & 0xf;
6285 9ee6e8bb pbrook
                if (op1 & 2) {
6286 9ee6e8bb pbrook
                    if (IS_USER(s))
6287 9ee6e8bb pbrook
                        goto illegal_op;
6288 d9ba4830 pbrook
                    tmp = load_cpu_field(spsr);
6289 9ee6e8bb pbrook
                } else {
6290 d9ba4830 pbrook
                    tmp = new_tmp();
6291 d9ba4830 pbrook
                    gen_helper_cpsr_read(tmp);
6292 9ee6e8bb pbrook
                }
6293 d9ba4830 pbrook
                store_reg(s, rd, tmp);
6294 9ee6e8bb pbrook
            }
6295 9ee6e8bb pbrook
            break;
6296 9ee6e8bb pbrook
        case 0x1:
6297 9ee6e8bb pbrook
            if (op1 == 1) {
6298 9ee6e8bb pbrook
                /* branch/exchange thumb (bx).  */
6299 d9ba4830 pbrook
                tmp = load_reg(s, rm);
6300 d9ba4830 pbrook
                gen_bx(s, tmp);
6301 9ee6e8bb pbrook
            } else if (op1 == 3) {
6302 9ee6e8bb pbrook
                /* clz */
6303 9ee6e8bb pbrook
                rd = (insn >> 12) & 0xf;
6304 1497c961 pbrook
                tmp = load_reg(s, rm);
6305 1497c961 pbrook
                gen_helper_clz(tmp, tmp);
6306 1497c961 pbrook
                store_reg(s, rd, tmp);
6307 9ee6e8bb pbrook
            } else {
6308 9ee6e8bb pbrook
                goto illegal_op;
6309 9ee6e8bb pbrook
            }
6310 9ee6e8bb pbrook
            break;
6311 9ee6e8bb pbrook
        case 0x2:
6312 9ee6e8bb pbrook
            if (op1 == 1) {
6313 9ee6e8bb pbrook
                ARCH(5J); /* bxj */
6314 9ee6e8bb pbrook
                /* Trivial implementation equivalent to bx.  */
6315 d9ba4830 pbrook
                tmp = load_reg(s, rm);
6316 d9ba4830 pbrook
                gen_bx(s, tmp);
6317 9ee6e8bb pbrook
            } else {
6318 9ee6e8bb pbrook
                goto illegal_op;
6319 9ee6e8bb pbrook
            }
6320 9ee6e8bb pbrook
            break;
6321 9ee6e8bb pbrook
        case 0x3:
6322 9ee6e8bb pbrook
            if (op1 != 1)
6323 9ee6e8bb pbrook
              goto illegal_op;
6324 9ee6e8bb pbrook
6325 9ee6e8bb pbrook
            /* branch link/exchange thumb (blx) */
6326 d9ba4830 pbrook
            tmp = load_reg(s, rm);
6327 d9ba4830 pbrook
            tmp2 = new_tmp();
6328 d9ba4830 pbrook
            tcg_gen_movi_i32(tmp2, s->pc);
6329 d9ba4830 pbrook
            store_reg(s, 14, tmp2);
6330 d9ba4830 pbrook
            gen_bx(s, tmp);
6331 9ee6e8bb pbrook
            break;
6332 9ee6e8bb pbrook
        case 0x5: /* saturating add/subtract */
6333 9ee6e8bb pbrook
            rd = (insn >> 12) & 0xf;
6334 9ee6e8bb pbrook
            rn = (insn >> 16) & 0xf;
6335 b40d0353 balrog
            tmp = load_reg(s, rm);
6336 5e3f878a pbrook
            tmp2 = load_reg(s, rn);
6337 9ee6e8bb pbrook
            if (op1 & 2)
6338 5e3f878a pbrook
                gen_helper_double_saturate(tmp2, tmp2);
6339 9ee6e8bb pbrook
            if (op1 & 1)
6340 5e3f878a pbrook
                gen_helper_sub_saturate(tmp, tmp, tmp2);
6341 9ee6e8bb pbrook
            else
6342 5e3f878a pbrook
                gen_helper_add_saturate(tmp, tmp, tmp2);
6343 5e3f878a pbrook
            dead_tmp(tmp2);
6344 5e3f878a pbrook
            store_reg(s, rd, tmp);
6345 9ee6e8bb pbrook
            break;
6346 9ee6e8bb pbrook
        case 7: /* bkpt */
6347 9ee6e8bb pbrook
            gen_set_condexec(s);
6348 5e3f878a pbrook
            gen_set_pc_im(s->pc - 4);
6349 d9ba4830 pbrook
            gen_exception(EXCP_BKPT);
6350 9ee6e8bb pbrook
            s->is_jmp = DISAS_JUMP;
6351 9ee6e8bb pbrook
            break;
6352 9ee6e8bb pbrook
        case 0x8: /* signed multiply */
6353 9ee6e8bb pbrook
        case 0xa:
6354 9ee6e8bb pbrook
        case 0xc:
6355 9ee6e8bb pbrook
        case 0xe:
6356 9ee6e8bb pbrook
            rs = (insn >> 8) & 0xf;
6357 9ee6e8bb pbrook
            rn = (insn >> 12) & 0xf;
6358 9ee6e8bb pbrook
            rd = (insn >> 16) & 0xf;
6359 9ee6e8bb pbrook
            if (op1 == 1) {
6360 9ee6e8bb pbrook
                /* (32 * 16) >> 16 */
6361 5e3f878a pbrook
                tmp = load_reg(s, rm);
6362 5e3f878a pbrook
                tmp2 = load_reg(s, rs);
6363 9ee6e8bb pbrook
                if (sh & 4)
6364 5e3f878a pbrook
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
6365 9ee6e8bb pbrook
                else
6366 5e3f878a pbrook
                    gen_sxth(tmp2);
6367 a7812ae4 pbrook
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
6368 a7812ae4 pbrook
                tcg_gen_shri_i64(tmp64, tmp64, 16);
6369 5e3f878a pbrook
                tmp = new_tmp();
6370 a7812ae4 pbrook
                tcg_gen_trunc_i64_i32(tmp, tmp64);
6371 b75263d6 Juha Riihimรคki
                tcg_temp_free_i64(tmp64);
6372 9ee6e8bb pbrook
                if ((sh & 2) == 0) {
6373 5e3f878a pbrook
                    tmp2 = load_reg(s, rn);
6374 5e3f878a pbrook
                    gen_helper_add_setq(tmp, tmp, tmp2);
6375 5e3f878a pbrook
                    dead_tmp(tmp2);
6376 9ee6e8bb pbrook
                }
6377 5e3f878a pbrook
                store_reg(s, rd, tmp);
6378 9ee6e8bb pbrook
            } else {
6379 9ee6e8bb pbrook
                /* 16 * 16 */
6380 5e3f878a pbrook
                tmp = load_reg(s, rm);
6381 5e3f878a pbrook
                tmp2 = load_reg(s, rs);
6382 5e3f878a pbrook
                gen_mulxy(tmp, tmp2, sh & 2, sh & 4);
6383 5e3f878a pbrook
                dead_tmp(tmp2);
6384 9ee6e8bb pbrook
                if (op1 == 2) {
6385 a7812ae4 pbrook
                    tmp64 = tcg_temp_new_i64();
6386 a7812ae4 pbrook
                    tcg_gen_ext_i32_i64(tmp64, tmp);
6387 22478e79 balrog
                    dead_tmp(tmp);
6388 a7812ae4 pbrook
                    gen_addq(s, tmp64, rn, rd);
6389 a7812ae4 pbrook
                    gen_storeq_reg(s, rn, rd, tmp64);
6390 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i64(tmp64);
6391 9ee6e8bb pbrook
                } else {
6392 9ee6e8bb pbrook
                    if (op1 == 0) {
6393 5e3f878a pbrook
                        tmp2 = load_reg(s, rn);
6394 5e3f878a pbrook
                        gen_helper_add_setq(tmp, tmp, tmp2);
6395 5e3f878a pbrook
                        dead_tmp(tmp2);
6396 9ee6e8bb pbrook
                    }
6397 5e3f878a pbrook
                    store_reg(s, rd, tmp);
6398 9ee6e8bb pbrook
                }
6399 9ee6e8bb pbrook
            }
6400 9ee6e8bb pbrook
            break;
6401 9ee6e8bb pbrook
        default:
6402 9ee6e8bb pbrook
            goto illegal_op;
6403 9ee6e8bb pbrook
        }
6404 9ee6e8bb pbrook
    } else if (((insn & 0x0e000000) == 0 &&
6405 9ee6e8bb pbrook
                (insn & 0x00000090) != 0x90) ||
6406 9ee6e8bb pbrook
               ((insn & 0x0e000000) == (1 << 25))) {
6407 9ee6e8bb pbrook
        int set_cc, logic_cc, shiftop;
6408 9ee6e8bb pbrook
6409 9ee6e8bb pbrook
        op1 = (insn >> 21) & 0xf;
6410 9ee6e8bb pbrook
        set_cc = (insn >> 20) & 1;
6411 9ee6e8bb pbrook
        logic_cc = table_logic_cc[op1] & set_cc;
6412 9ee6e8bb pbrook
6413 9ee6e8bb pbrook
        /* data processing instruction */
6414 9ee6e8bb pbrook
        if (insn & (1 << 25)) {
6415 9ee6e8bb pbrook
            /* immediate operand */
6416 9ee6e8bb pbrook
            val = insn & 0xff;
6417 9ee6e8bb pbrook
            shift = ((insn >> 8) & 0xf) * 2;
6418 e9bb4aa9 Juha Riihimรคki
            if (shift) {
6419 9ee6e8bb pbrook
                val = (val >> shift) | (val << (32 - shift));
6420 e9bb4aa9 Juha Riihimรคki
            }
6421 e9bb4aa9 Juha Riihimรคki
            tmp2 = new_tmp();
6422 e9bb4aa9 Juha Riihimรคki
            tcg_gen_movi_i32(tmp2, val);
6423 e9bb4aa9 Juha Riihimรคki
            if (logic_cc && shift) {
6424 e9bb4aa9 Juha Riihimรคki
                gen_set_CF_bit31(tmp2);
6425 e9bb4aa9 Juha Riihimรคki
            }
6426 9ee6e8bb pbrook
        } else {
6427 9ee6e8bb pbrook
            /* register */
6428 9ee6e8bb pbrook
            rm = (insn) & 0xf;
6429 e9bb4aa9 Juha Riihimรคki
            tmp2 = load_reg(s, rm);
6430 9ee6e8bb pbrook
            shiftop = (insn >> 5) & 3;
6431 9ee6e8bb pbrook
            if (!(insn & (1 << 4))) {
6432 9ee6e8bb pbrook
                shift = (insn >> 7) & 0x1f;
6433 e9bb4aa9 Juha Riihimรคki
                gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
6434 9ee6e8bb pbrook
            } else {
6435 9ee6e8bb pbrook
                rs = (insn >> 8) & 0xf;
6436 8984bd2e pbrook
                tmp = load_reg(s, rs);
6437 e9bb4aa9 Juha Riihimรคki
                gen_arm_shift_reg(tmp2, shiftop, tmp, logic_cc);
6438 9ee6e8bb pbrook
            }
6439 9ee6e8bb pbrook
        }
6440 9ee6e8bb pbrook
        if (op1 != 0x0f && op1 != 0x0d) {
6441 9ee6e8bb pbrook
            rn = (insn >> 16) & 0xf;
6442 e9bb4aa9 Juha Riihimรคki
            tmp = load_reg(s, rn);
6443 e9bb4aa9 Juha Riihimรคki
        } else {
6444 e9bb4aa9 Juha Riihimรคki
            TCGV_UNUSED(tmp);
6445 9ee6e8bb pbrook
        }
6446 9ee6e8bb pbrook
        rd = (insn >> 12) & 0xf;
6447 9ee6e8bb pbrook
        switch(op1) {
6448 9ee6e8bb pbrook
        case 0x00:
6449 e9bb4aa9 Juha Riihimรคki
            tcg_gen_and_i32(tmp, tmp, tmp2);
6450 e9bb4aa9 Juha Riihimรคki
            if (logic_cc) {
6451 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6452 e9bb4aa9 Juha Riihimรคki
            }
6453 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6454 9ee6e8bb pbrook
            break;
6455 9ee6e8bb pbrook
        case 0x01:
6456 e9bb4aa9 Juha Riihimรคki
            tcg_gen_xor_i32(tmp, tmp, tmp2);
6457 e9bb4aa9 Juha Riihimรคki
            if (logic_cc) {
6458 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6459 e9bb4aa9 Juha Riihimรคki
            }
6460 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6461 9ee6e8bb pbrook
            break;
6462 9ee6e8bb pbrook
        case 0x02:
6463 9ee6e8bb pbrook
            if (set_cc && rd == 15) {
6464 9ee6e8bb pbrook
                /* SUBS r15, ... is used for exception return.  */
6465 e9bb4aa9 Juha Riihimรคki
                if (IS_USER(s)) {
6466 9ee6e8bb pbrook
                    goto illegal_op;
6467 e9bb4aa9 Juha Riihimรคki
                }
6468 e9bb4aa9 Juha Riihimรคki
                gen_helper_sub_cc(tmp, tmp, tmp2);
6469 e9bb4aa9 Juha Riihimรคki
                gen_exception_return(s, tmp);
6470 9ee6e8bb pbrook
            } else {
6471 e9bb4aa9 Juha Riihimรคki
                if (set_cc) {
6472 e9bb4aa9 Juha Riihimรคki
                    gen_helper_sub_cc(tmp, tmp, tmp2);
6473 e9bb4aa9 Juha Riihimรคki
                } else {
6474 e9bb4aa9 Juha Riihimรคki
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
6475 e9bb4aa9 Juha Riihimรคki
                }
6476 21aeb343 Juha Riihimรคki
                store_reg_bx(env, s, rd, tmp);
6477 9ee6e8bb pbrook
            }
6478 9ee6e8bb pbrook
            break;
6479 9ee6e8bb pbrook
        case 0x03:
6480 e9bb4aa9 Juha Riihimรคki
            if (set_cc) {
6481 e9bb4aa9 Juha Riihimรคki
                gen_helper_sub_cc(tmp, tmp2, tmp);
6482 e9bb4aa9 Juha Riihimรคki
            } else {
6483 e9bb4aa9 Juha Riihimรคki
                tcg_gen_sub_i32(tmp, tmp2, tmp);
6484 e9bb4aa9 Juha Riihimรคki
            }
6485 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6486 9ee6e8bb pbrook
            break;
6487 9ee6e8bb pbrook
        case 0x04:
6488 e9bb4aa9 Juha Riihimรคki
            if (set_cc) {
6489 e9bb4aa9 Juha Riihimรคki
                gen_helper_add_cc(tmp, tmp, tmp2);
6490 e9bb4aa9 Juha Riihimรคki
            } else {
6491 e9bb4aa9 Juha Riihimรคki
                tcg_gen_add_i32(tmp, tmp, tmp2);
6492 e9bb4aa9 Juha Riihimรคki
            }
6493 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6494 9ee6e8bb pbrook
            break;
6495 9ee6e8bb pbrook
        case 0x05:
6496 e9bb4aa9 Juha Riihimรคki
            if (set_cc) {
6497 e9bb4aa9 Juha Riihimรคki
                gen_helper_adc_cc(tmp, tmp, tmp2);
6498 e9bb4aa9 Juha Riihimรคki
            } else {
6499 e9bb4aa9 Juha Riihimรคki
                gen_add_carry(tmp, tmp, tmp2);
6500 e9bb4aa9 Juha Riihimรคki
            }
6501 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6502 9ee6e8bb pbrook
            break;
6503 9ee6e8bb pbrook
        case 0x06:
6504 e9bb4aa9 Juha Riihimรคki
            if (set_cc) {
6505 e9bb4aa9 Juha Riihimรคki
                gen_helper_sbc_cc(tmp, tmp, tmp2);
6506 e9bb4aa9 Juha Riihimรคki
            } else {
6507 e9bb4aa9 Juha Riihimรคki
                gen_sub_carry(tmp, tmp, tmp2);
6508 e9bb4aa9 Juha Riihimรคki
            }
6509 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6510 9ee6e8bb pbrook
            break;
6511 9ee6e8bb pbrook
        case 0x07:
6512 e9bb4aa9 Juha Riihimรคki
            if (set_cc) {
6513 e9bb4aa9 Juha Riihimรคki
                gen_helper_sbc_cc(tmp, tmp2, tmp);
6514 e9bb4aa9 Juha Riihimรคki
            } else {
6515 e9bb4aa9 Juha Riihimรคki
                gen_sub_carry(tmp, tmp2, tmp);
6516 e9bb4aa9 Juha Riihimรคki
            }
6517 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6518 9ee6e8bb pbrook
            break;
6519 9ee6e8bb pbrook
        case 0x08:
6520 9ee6e8bb pbrook
            if (set_cc) {
6521 e9bb4aa9 Juha Riihimรคki
                tcg_gen_and_i32(tmp, tmp, tmp2);
6522 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6523 9ee6e8bb pbrook
            }
6524 e9bb4aa9 Juha Riihimรคki
            dead_tmp(tmp);
6525 9ee6e8bb pbrook
            break;
6526 9ee6e8bb pbrook
        case 0x09:
6527 9ee6e8bb pbrook
            if (set_cc) {
6528 e9bb4aa9 Juha Riihimรคki
                tcg_gen_xor_i32(tmp, tmp, tmp2);
6529 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6530 9ee6e8bb pbrook
            }
6531 e9bb4aa9 Juha Riihimรคki
            dead_tmp(tmp);
6532 9ee6e8bb pbrook
            break;
6533 9ee6e8bb pbrook
        case 0x0a:
6534 9ee6e8bb pbrook
            if (set_cc) {
6535 e9bb4aa9 Juha Riihimรคki
                gen_helper_sub_cc(tmp, tmp, tmp2);
6536 9ee6e8bb pbrook
            }
6537 e9bb4aa9 Juha Riihimรคki
            dead_tmp(tmp);
6538 9ee6e8bb pbrook
            break;
6539 9ee6e8bb pbrook
        case 0x0b:
6540 9ee6e8bb pbrook
            if (set_cc) {
6541 e9bb4aa9 Juha Riihimรคki
                gen_helper_add_cc(tmp, tmp, tmp2);
6542 9ee6e8bb pbrook
            }
6543 e9bb4aa9 Juha Riihimรคki
            dead_tmp(tmp);
6544 9ee6e8bb pbrook
            break;
6545 9ee6e8bb pbrook
        case 0x0c:
6546 e9bb4aa9 Juha Riihimรคki
            tcg_gen_or_i32(tmp, tmp, tmp2);
6547 e9bb4aa9 Juha Riihimรคki
            if (logic_cc) {
6548 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6549 e9bb4aa9 Juha Riihimรคki
            }
6550 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6551 9ee6e8bb pbrook
            break;
6552 9ee6e8bb pbrook
        case 0x0d:
6553 9ee6e8bb pbrook
            if (logic_cc && rd == 15) {
6554 9ee6e8bb pbrook
                /* MOVS r15, ... is used for exception return.  */
6555 e9bb4aa9 Juha Riihimรคki
                if (IS_USER(s)) {
6556 9ee6e8bb pbrook
                    goto illegal_op;
6557 e9bb4aa9 Juha Riihimรคki
                }
6558 e9bb4aa9 Juha Riihimรคki
                gen_exception_return(s, tmp2);
6559 9ee6e8bb pbrook
            } else {
6560 e9bb4aa9 Juha Riihimรคki
                if (logic_cc) {
6561 e9bb4aa9 Juha Riihimรคki
                    gen_logic_CC(tmp2);
6562 e9bb4aa9 Juha Riihimรคki
                }
6563 21aeb343 Juha Riihimรคki
                store_reg_bx(env, s, rd, tmp2);
6564 9ee6e8bb pbrook
            }
6565 9ee6e8bb pbrook
            break;
6566 9ee6e8bb pbrook
        case 0x0e:
6567 f669df27 Aurelien Jarno
            tcg_gen_andc_i32(tmp, tmp, tmp2);
6568 e9bb4aa9 Juha Riihimรคki
            if (logic_cc) {
6569 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp);
6570 e9bb4aa9 Juha Riihimรคki
            }
6571 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
6572 9ee6e8bb pbrook
            break;
6573 9ee6e8bb pbrook
        default:
6574 9ee6e8bb pbrook
        case 0x0f:
6575 e9bb4aa9 Juha Riihimรคki
            tcg_gen_not_i32(tmp2, tmp2);
6576 e9bb4aa9 Juha Riihimรคki
            if (logic_cc) {
6577 e9bb4aa9 Juha Riihimรคki
                gen_logic_CC(tmp2);
6578 e9bb4aa9 Juha Riihimรคki
            }
6579 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp2);
6580 9ee6e8bb pbrook
            break;
6581 9ee6e8bb pbrook
        }
6582 e9bb4aa9 Juha Riihimรคki
        if (op1 != 0x0f && op1 != 0x0d) {
6583 e9bb4aa9 Juha Riihimรคki
            dead_tmp(tmp2);
6584 e9bb4aa9 Juha Riihimรคki
        }
6585 9ee6e8bb pbrook
    } else {
6586 9ee6e8bb pbrook
        /* other instructions */
6587 9ee6e8bb pbrook
        op1 = (insn >> 24) & 0xf;
6588 9ee6e8bb pbrook
        switch(op1) {
6589 9ee6e8bb pbrook
        case 0x0:
6590 9ee6e8bb pbrook
        case 0x1:
6591 9ee6e8bb pbrook
            /* multiplies, extra load/stores */
6592 9ee6e8bb pbrook
            sh = (insn >> 5) & 3;
6593 9ee6e8bb pbrook
            if (sh == 0) {
6594 9ee6e8bb pbrook
                if (op1 == 0x0) {
6595 9ee6e8bb pbrook
                    rd = (insn >> 16) & 0xf;
6596 9ee6e8bb pbrook
                    rn = (insn >> 12) & 0xf;
6597 9ee6e8bb pbrook
                    rs = (insn >> 8) & 0xf;
6598 9ee6e8bb pbrook
                    rm = (insn) & 0xf;
6599 9ee6e8bb pbrook
                    op1 = (insn >> 20) & 0xf;
6600 9ee6e8bb pbrook
                    switch (op1) {
6601 9ee6e8bb pbrook
                    case 0: case 1: case 2: case 3: case 6:
6602 9ee6e8bb pbrook
                        /* 32 bit mul */
6603 5e3f878a pbrook
                        tmp = load_reg(s, rs);
6604 5e3f878a pbrook
                        tmp2 = load_reg(s, rm);
6605 5e3f878a pbrook
                        tcg_gen_mul_i32(tmp, tmp, tmp2);
6606 5e3f878a pbrook
                        dead_tmp(tmp2);
6607 9ee6e8bb pbrook
                        if (insn & (1 << 22)) {
6608 9ee6e8bb pbrook
                            /* Subtract (mls) */
6609 9ee6e8bb pbrook
                            ARCH(6T2);
6610 5e3f878a pbrook
                            tmp2 = load_reg(s, rn);
6611 5e3f878a pbrook
                            tcg_gen_sub_i32(tmp, tmp2, tmp);
6612 5e3f878a pbrook
                            dead_tmp(tmp2);
6613 9ee6e8bb pbrook
                        } else if (insn & (1 << 21)) {
6614 9ee6e8bb pbrook
                            /* Add */
6615 5e3f878a pbrook
                            tmp2 = load_reg(s, rn);
6616 5e3f878a pbrook
                            tcg_gen_add_i32(tmp, tmp, tmp2);
6617 5e3f878a pbrook
                            dead_tmp(tmp2);
6618 9ee6e8bb pbrook
                        }
6619 9ee6e8bb pbrook
                        if (insn & (1 << 20))
6620 5e3f878a pbrook
                            gen_logic_CC(tmp);
6621 5e3f878a pbrook
                        store_reg(s, rd, tmp);
6622 9ee6e8bb pbrook
                        break;
6623 9ee6e8bb pbrook
                    default:
6624 9ee6e8bb pbrook
                        /* 64 bit mul */
6625 5e3f878a pbrook
                        tmp = load_reg(s, rs);
6626 5e3f878a pbrook
                        tmp2 = load_reg(s, rm);
6627 9ee6e8bb pbrook
                        if (insn & (1 << 22))
6628 a7812ae4 pbrook
                            tmp64 = gen_muls_i64_i32(tmp, tmp2);
6629 9ee6e8bb pbrook
                        else
6630 a7812ae4 pbrook
                            tmp64 = gen_mulu_i64_i32(tmp, tmp2);
6631 9ee6e8bb pbrook
                        if (insn & (1 << 21)) /* mult accumulate */
6632 a7812ae4 pbrook
                            gen_addq(s, tmp64, rn, rd);
6633 9ee6e8bb pbrook
                        if (!(insn & (1 << 23))) { /* double accumulate */
6634 9ee6e8bb pbrook
                            ARCH(6);
6635 a7812ae4 pbrook
                            gen_addq_lo(s, tmp64, rn);
6636 a7812ae4 pbrook
                            gen_addq_lo(s, tmp64, rd);
6637 9ee6e8bb pbrook
                        }
6638 9ee6e8bb pbrook
                        if (insn & (1 << 20))
6639 a7812ae4 pbrook
                            gen_logicq_cc(tmp64);
6640 a7812ae4 pbrook
                        gen_storeq_reg(s, rn, rd, tmp64);
6641 b75263d6 Juha Riihimรคki
                        tcg_temp_free_i64(tmp64);
6642 9ee6e8bb pbrook
                        break;
6643 9ee6e8bb pbrook
                    }
6644 9ee6e8bb pbrook
                } else {
6645 9ee6e8bb pbrook
                    rn = (insn >> 16) & 0xf;
6646 9ee6e8bb pbrook
                    rd = (insn >> 12) & 0xf;
6647 9ee6e8bb pbrook
                    if (insn & (1 << 23)) {
6648 9ee6e8bb pbrook
                        /* load/store exclusive */
6649 86753403 pbrook
                        op1 = (insn >> 21) & 0x3;
6650 86753403 pbrook
                        if (op1)
6651 a47f43d2 pbrook
                            ARCH(6K);
6652 86753403 pbrook
                        else
6653 86753403 pbrook
                            ARCH(6);
6654 3174f8e9 Filip Navara
                        addr = tcg_temp_local_new_i32();
6655 98a46317 Aurelien Jarno
                        load_reg_var(s, addr, rn);
6656 9ee6e8bb pbrook
                        if (insn & (1 << 20)) {
6657 86753403 pbrook
                            switch (op1) {
6658 86753403 pbrook
                            case 0: /* ldrex */
6659 426f5abc Paul Brook
                                gen_load_exclusive(s, rd, 15, addr, 2);
6660 86753403 pbrook
                                break;
6661 86753403 pbrook
                            case 1: /* ldrexd */
6662 426f5abc Paul Brook
                                gen_load_exclusive(s, rd, rd + 1, addr, 3);
6663 86753403 pbrook
                                break;
6664 86753403 pbrook
                            case 2: /* ldrexb */
6665 426f5abc Paul Brook
                                gen_load_exclusive(s, rd, 15, addr, 0);
6666 86753403 pbrook
                                break;
6667 86753403 pbrook
                            case 3: /* ldrexh */
6668 426f5abc Paul Brook
                                gen_load_exclusive(s, rd, 15, addr, 1);
6669 86753403 pbrook
                                break;
6670 86753403 pbrook
                            default:
6671 86753403 pbrook
                                abort();
6672 86753403 pbrook
                            }
6673 9ee6e8bb pbrook
                        } else {
6674 9ee6e8bb pbrook
                            rm = insn & 0xf;
6675 86753403 pbrook
                            switch (op1) {
6676 86753403 pbrook
                            case 0:  /*  strex */
6677 426f5abc Paul Brook
                                gen_store_exclusive(s, rd, rm, 15, addr, 2);
6678 86753403 pbrook
                                break;
6679 86753403 pbrook
                            case 1: /*  strexd */
6680 502e64fe Aurelien Jarno
                                gen_store_exclusive(s, rd, rm, rm + 1, addr, 3);
6681 86753403 pbrook
                                break;
6682 86753403 pbrook
                            case 2: /*  strexb */
6683 426f5abc Paul Brook
                                gen_store_exclusive(s, rd, rm, 15, addr, 0);
6684 86753403 pbrook
                                break;
6685 86753403 pbrook
                            case 3: /* strexh */
6686 426f5abc Paul Brook
                                gen_store_exclusive(s, rd, rm, 15, addr, 1);
6687 86753403 pbrook
                                break;
6688 86753403 pbrook
                            default:
6689 86753403 pbrook
                                abort();
6690 86753403 pbrook
                            }
6691 9ee6e8bb pbrook
                        }
6692 3174f8e9 Filip Navara
                        tcg_temp_free(addr);
6693 9ee6e8bb pbrook
                    } else {
6694 9ee6e8bb pbrook
                        /* SWP instruction */
6695 9ee6e8bb pbrook
                        rm = (insn) & 0xf;
6696 9ee6e8bb pbrook
6697 8984bd2e pbrook
                        /* ??? This is not really atomic.  However we know
6698 8984bd2e pbrook
                           we never have multiple CPUs running in parallel,
6699 8984bd2e pbrook
                           so it is good enough.  */
6700 8984bd2e pbrook
                        addr = load_reg(s, rn);
6701 8984bd2e pbrook
                        tmp = load_reg(s, rm);
6702 9ee6e8bb pbrook
                        if (insn & (1 << 22)) {
6703 8984bd2e pbrook
                            tmp2 = gen_ld8u(addr, IS_USER(s));
6704 8984bd2e pbrook
                            gen_st8(tmp, addr, IS_USER(s));
6705 9ee6e8bb pbrook
                        } else {
6706 8984bd2e pbrook
                            tmp2 = gen_ld32(addr, IS_USER(s));
6707 8984bd2e pbrook
                            gen_st32(tmp, addr, IS_USER(s));
6708 9ee6e8bb pbrook
                        }
6709 8984bd2e pbrook
                        dead_tmp(addr);
6710 8984bd2e pbrook
                        store_reg(s, rd, tmp2);
6711 9ee6e8bb pbrook
                    }
6712 9ee6e8bb pbrook
                }
6713 9ee6e8bb pbrook
            } else {
6714 9ee6e8bb pbrook
                int address_offset;
6715 9ee6e8bb pbrook
                int load;
6716 9ee6e8bb pbrook
                /* Misc load/store */
6717 9ee6e8bb pbrook
                rn = (insn >> 16) & 0xf;
6718 9ee6e8bb pbrook
                rd = (insn >> 12) & 0xf;
6719 b0109805 pbrook
                addr = load_reg(s, rn);
6720 9ee6e8bb pbrook
                if (insn & (1 << 24))
6721 b0109805 pbrook
                    gen_add_datah_offset(s, insn, 0, addr);
6722 9ee6e8bb pbrook
                address_offset = 0;
6723 9ee6e8bb pbrook
                if (insn & (1 << 20)) {
6724 9ee6e8bb pbrook
                    /* load */
6725 9ee6e8bb pbrook
                    switch(sh) {
6726 9ee6e8bb pbrook
                    case 1:
6727 b0109805 pbrook
                        tmp = gen_ld16u(addr, IS_USER(s));
6728 9ee6e8bb pbrook
                        break;
6729 9ee6e8bb pbrook
                    case 2:
6730 b0109805 pbrook
                        tmp = gen_ld8s(addr, IS_USER(s));
6731 9ee6e8bb pbrook
                        break;
6732 9ee6e8bb pbrook
                    default:
6733 9ee6e8bb pbrook
                    case 3:
6734 b0109805 pbrook
                        tmp = gen_ld16s(addr, IS_USER(s));
6735 9ee6e8bb pbrook
                        break;
6736 9ee6e8bb pbrook
                    }
6737 9ee6e8bb pbrook
                    load = 1;
6738 9ee6e8bb pbrook
                } else if (sh & 2) {
6739 9ee6e8bb pbrook
                    /* doubleword */
6740 9ee6e8bb pbrook
                    if (sh & 1) {
6741 9ee6e8bb pbrook
                        /* store */
6742 b0109805 pbrook
                        tmp = load_reg(s, rd);
6743 b0109805 pbrook
                        gen_st32(tmp, addr, IS_USER(s));
6744 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, 4);
6745 b0109805 pbrook
                        tmp = load_reg(s, rd + 1);
6746 b0109805 pbrook
                        gen_st32(tmp, addr, IS_USER(s));
6747 9ee6e8bb pbrook
                        load = 0;
6748 9ee6e8bb pbrook
                    } else {
6749 9ee6e8bb pbrook
                        /* load */
6750 b0109805 pbrook
                        tmp = gen_ld32(addr, IS_USER(s));
6751 b0109805 pbrook
                        store_reg(s, rd, tmp);
6752 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, 4);
6753 b0109805 pbrook
                        tmp = gen_ld32(addr, IS_USER(s));
6754 9ee6e8bb pbrook
                        rd++;
6755 9ee6e8bb pbrook
                        load = 1;
6756 9ee6e8bb pbrook
                    }
6757 9ee6e8bb pbrook
                    address_offset = -4;
6758 9ee6e8bb pbrook
                } else {
6759 9ee6e8bb pbrook
                    /* store */
6760 b0109805 pbrook
                    tmp = load_reg(s, rd);
6761 b0109805 pbrook
                    gen_st16(tmp, addr, IS_USER(s));
6762 9ee6e8bb pbrook
                    load = 0;
6763 9ee6e8bb pbrook
                }
6764 9ee6e8bb pbrook
                /* Perform base writeback before the loaded value to
6765 9ee6e8bb pbrook
                   ensure correct behavior with overlapping index registers.
6766 9ee6e8bb pbrook
                   ldrd with base writeback is is undefined if the
6767 9ee6e8bb pbrook
                   destination and index registers overlap.  */
6768 9ee6e8bb pbrook
                if (!(insn & (1 << 24))) {
6769 b0109805 pbrook
                    gen_add_datah_offset(s, insn, address_offset, addr);
6770 b0109805 pbrook
                    store_reg(s, rn, addr);
6771 9ee6e8bb pbrook
                } else if (insn & (1 << 21)) {
6772 9ee6e8bb pbrook
                    if (address_offset)
6773 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, address_offset);
6774 b0109805 pbrook
                    store_reg(s, rn, addr);
6775 b0109805 pbrook
                } else {
6776 b0109805 pbrook
                    dead_tmp(addr);
6777 9ee6e8bb pbrook
                }
6778 9ee6e8bb pbrook
                if (load) {
6779 9ee6e8bb pbrook
                    /* Complete the load.  */
6780 b0109805 pbrook
                    store_reg(s, rd, tmp);
6781 9ee6e8bb pbrook
                }
6782 9ee6e8bb pbrook
            }
6783 9ee6e8bb pbrook
            break;
6784 9ee6e8bb pbrook
        case 0x4:
6785 9ee6e8bb pbrook
        case 0x5:
6786 9ee6e8bb pbrook
            goto do_ldst;
6787 9ee6e8bb pbrook
        case 0x6:
6788 9ee6e8bb pbrook
        case 0x7:
6789 9ee6e8bb pbrook
            if (insn & (1 << 4)) {
6790 9ee6e8bb pbrook
                ARCH(6);
6791 9ee6e8bb pbrook
                /* Armv6 Media instructions.  */
6792 9ee6e8bb pbrook
                rm = insn & 0xf;
6793 9ee6e8bb pbrook
                rn = (insn >> 16) & 0xf;
6794 2c0262af bellard
                rd = (insn >> 12) & 0xf;
6795 9ee6e8bb pbrook
                rs = (insn >> 8) & 0xf;
6796 9ee6e8bb pbrook
                switch ((insn >> 23) & 3) {
6797 9ee6e8bb pbrook
                case 0: /* Parallel add/subtract.  */
6798 9ee6e8bb pbrook
                    op1 = (insn >> 20) & 7;
6799 6ddbc6e4 pbrook
                    tmp = load_reg(s, rn);
6800 6ddbc6e4 pbrook
                    tmp2 = load_reg(s, rm);
6801 9ee6e8bb pbrook
                    sh = (insn >> 5) & 7;
6802 9ee6e8bb pbrook
                    if ((op1 & 3) == 0 || sh == 5 || sh == 6)
6803 9ee6e8bb pbrook
                        goto illegal_op;
6804 6ddbc6e4 pbrook
                    gen_arm_parallel_addsub(op1, sh, tmp, tmp2);
6805 6ddbc6e4 pbrook
                    dead_tmp(tmp2);
6806 6ddbc6e4 pbrook
                    store_reg(s, rd, tmp);
6807 9ee6e8bb pbrook
                    break;
6808 9ee6e8bb pbrook
                case 1:
6809 9ee6e8bb pbrook
                    if ((insn & 0x00700020) == 0) {
6810 6c95676b balrog
                        /* Halfword pack.  */
6811 3670669c pbrook
                        tmp = load_reg(s, rn);
6812 3670669c pbrook
                        tmp2 = load_reg(s, rm);
6813 9ee6e8bb pbrook
                        shift = (insn >> 7) & 0x1f;
6814 3670669c pbrook
                        if (insn & (1 << 6)) {
6815 3670669c pbrook
                            /* pkhtb */
6816 22478e79 balrog
                            if (shift == 0)
6817 22478e79 balrog
                                shift = 31;
6818 22478e79 balrog
                            tcg_gen_sari_i32(tmp2, tmp2, shift);
6819 3670669c pbrook
                            tcg_gen_andi_i32(tmp, tmp, 0xffff0000);
6820 86831435 pbrook
                            tcg_gen_ext16u_i32(tmp2, tmp2);
6821 3670669c pbrook
                        } else {
6822 3670669c pbrook
                            /* pkhbt */
6823 22478e79 balrog
                            if (shift)
6824 22478e79 balrog
                                tcg_gen_shli_i32(tmp2, tmp2, shift);
6825 86831435 pbrook
                            tcg_gen_ext16u_i32(tmp, tmp);
6826 3670669c pbrook
                            tcg_gen_andi_i32(tmp2, tmp2, 0xffff0000);
6827 3670669c pbrook
                        }
6828 3670669c pbrook
                        tcg_gen_or_i32(tmp, tmp, tmp2);
6829 22478e79 balrog
                        dead_tmp(tmp2);
6830 3670669c pbrook
                        store_reg(s, rd, tmp);
6831 9ee6e8bb pbrook
                    } else if ((insn & 0x00200020) == 0x00200000) {
6832 9ee6e8bb pbrook
                        /* [us]sat */
6833 6ddbc6e4 pbrook
                        tmp = load_reg(s, rm);
6834 9ee6e8bb pbrook
                        shift = (insn >> 7) & 0x1f;
6835 9ee6e8bb pbrook
                        if (insn & (1 << 6)) {
6836 9ee6e8bb pbrook
                            if (shift == 0)
6837 9ee6e8bb pbrook
                                shift = 31;
6838 6ddbc6e4 pbrook
                            tcg_gen_sari_i32(tmp, tmp, shift);
6839 9ee6e8bb pbrook
                        } else {
6840 6ddbc6e4 pbrook
                            tcg_gen_shli_i32(tmp, tmp, shift);
6841 9ee6e8bb pbrook
                        }
6842 9ee6e8bb pbrook
                        sh = (insn >> 16) & 0x1f;
6843 9ee6e8bb pbrook
                        if (sh != 0) {
6844 b75263d6 Juha Riihimรคki
                            tmp2 = tcg_const_i32(sh);
6845 9ee6e8bb pbrook
                            if (insn & (1 << 22))
6846 b75263d6 Juha Riihimรคki
                                gen_helper_usat(tmp, tmp, tmp2);
6847 9ee6e8bb pbrook
                            else
6848 b75263d6 Juha Riihimรคki
                                gen_helper_ssat(tmp, tmp, tmp2);
6849 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i32(tmp2);
6850 9ee6e8bb pbrook
                        }
6851 6ddbc6e4 pbrook
                        store_reg(s, rd, tmp);
6852 9ee6e8bb pbrook
                    } else if ((insn & 0x00300fe0) == 0x00200f20) {
6853 9ee6e8bb pbrook
                        /* [us]sat16 */
6854 6ddbc6e4 pbrook
                        tmp = load_reg(s, rm);
6855 9ee6e8bb pbrook
                        sh = (insn >> 16) & 0x1f;
6856 9ee6e8bb pbrook
                        if (sh != 0) {
6857 b75263d6 Juha Riihimรคki
                            tmp2 = tcg_const_i32(sh);
6858 9ee6e8bb pbrook
                            if (insn & (1 << 22))
6859 b75263d6 Juha Riihimรคki
                                gen_helper_usat16(tmp, tmp, tmp2);
6860 9ee6e8bb pbrook
                            else
6861 b75263d6 Juha Riihimรคki
                                gen_helper_ssat16(tmp, tmp, tmp2);
6862 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i32(tmp2);
6863 9ee6e8bb pbrook
                        }
6864 6ddbc6e4 pbrook
                        store_reg(s, rd, tmp);
6865 9ee6e8bb pbrook
                    } else if ((insn & 0x00700fe0) == 0x00000fa0) {
6866 9ee6e8bb pbrook
                        /* Select bytes.  */
6867 6ddbc6e4 pbrook
                        tmp = load_reg(s, rn);
6868 6ddbc6e4 pbrook
                        tmp2 = load_reg(s, rm);
6869 6ddbc6e4 pbrook
                        tmp3 = new_tmp();
6870 6ddbc6e4 pbrook
                        tcg_gen_ld_i32(tmp3, cpu_env, offsetof(CPUState, GE));
6871 6ddbc6e4 pbrook
                        gen_helper_sel_flags(tmp, tmp3, tmp, tmp2);
6872 6ddbc6e4 pbrook
                        dead_tmp(tmp3);
6873 6ddbc6e4 pbrook
                        dead_tmp(tmp2);
6874 6ddbc6e4 pbrook
                        store_reg(s, rd, tmp);
6875 9ee6e8bb pbrook
                    } else if ((insn & 0x000003e0) == 0x00000060) {
6876 5e3f878a pbrook
                        tmp = load_reg(s, rm);
6877 9ee6e8bb pbrook
                        shift = (insn >> 10) & 3;
6878 9ee6e8bb pbrook
                        /* ??? In many cases it's not neccessary to do a
6879 9ee6e8bb pbrook
                           rotate, a shift is sufficient.  */
6880 9ee6e8bb pbrook
                        if (shift != 0)
6881 f669df27 Aurelien Jarno
                            tcg_gen_rotri_i32(tmp, tmp, shift * 8);
6882 9ee6e8bb pbrook
                        op1 = (insn >> 20) & 7;
6883 9ee6e8bb pbrook
                        switch (op1) {
6884 5e3f878a pbrook
                        case 0: gen_sxtb16(tmp);  break;
6885 5e3f878a pbrook
                        case 2: gen_sxtb(tmp);    break;
6886 5e3f878a pbrook
                        case 3: gen_sxth(tmp);    break;
6887 5e3f878a pbrook
                        case 4: gen_uxtb16(tmp);  break;
6888 5e3f878a pbrook
                        case 6: gen_uxtb(tmp);    break;
6889 5e3f878a pbrook
                        case 7: gen_uxth(tmp);    break;
6890 9ee6e8bb pbrook
                        default: goto illegal_op;
6891 9ee6e8bb pbrook
                        }
6892 9ee6e8bb pbrook
                        if (rn != 15) {
6893 5e3f878a pbrook
                            tmp2 = load_reg(s, rn);
6894 9ee6e8bb pbrook
                            if ((op1 & 3) == 0) {
6895 5e3f878a pbrook
                                gen_add16(tmp, tmp2);
6896 9ee6e8bb pbrook
                            } else {
6897 5e3f878a pbrook
                                tcg_gen_add_i32(tmp, tmp, tmp2);
6898 5e3f878a pbrook
                                dead_tmp(tmp2);
6899 9ee6e8bb pbrook
                            }
6900 9ee6e8bb pbrook
                        }
6901 6c95676b balrog
                        store_reg(s, rd, tmp);
6902 9ee6e8bb pbrook
                    } else if ((insn & 0x003f0f60) == 0x003f0f20) {
6903 9ee6e8bb pbrook
                        /* rev */
6904 b0109805 pbrook
                        tmp = load_reg(s, rm);
6905 9ee6e8bb pbrook
                        if (insn & (1 << 22)) {
6906 9ee6e8bb pbrook
                            if (insn & (1 << 7)) {
6907 b0109805 pbrook
                                gen_revsh(tmp);
6908 9ee6e8bb pbrook
                            } else {
6909 9ee6e8bb pbrook
                                ARCH(6T2);
6910 b0109805 pbrook
                                gen_helper_rbit(tmp, tmp);
6911 9ee6e8bb pbrook
                            }
6912 9ee6e8bb pbrook
                        } else {
6913 9ee6e8bb pbrook
                            if (insn & (1 << 7))
6914 b0109805 pbrook
                                gen_rev16(tmp);
6915 9ee6e8bb pbrook
                            else
6916 66896cb8 aurel32
                                tcg_gen_bswap32_i32(tmp, tmp);
6917 9ee6e8bb pbrook
                        }
6918 b0109805 pbrook
                        store_reg(s, rd, tmp);
6919 9ee6e8bb pbrook
                    } else {
6920 9ee6e8bb pbrook
                        goto illegal_op;
6921 9ee6e8bb pbrook
                    }
6922 9ee6e8bb pbrook
                    break;
6923 9ee6e8bb pbrook
                case 2: /* Multiplies (Type 3).  */
6924 5e3f878a pbrook
                    tmp = load_reg(s, rm);
6925 5e3f878a pbrook
                    tmp2 = load_reg(s, rs);
6926 9ee6e8bb pbrook
                    if (insn & (1 << 20)) {
6927 9ee6e8bb pbrook
                        /* Signed multiply most significant [accumulate].  */
6928 a7812ae4 pbrook
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
6929 9ee6e8bb pbrook
                        if (insn & (1 << 5))
6930 a7812ae4 pbrook
                            tcg_gen_addi_i64(tmp64, tmp64, 0x80000000u);
6931 a7812ae4 pbrook
                        tcg_gen_shri_i64(tmp64, tmp64, 32);
6932 5e3f878a pbrook
                        tmp = new_tmp();
6933 a7812ae4 pbrook
                        tcg_gen_trunc_i64_i32(tmp, tmp64);
6934 b75263d6 Juha Riihimรคki
                        tcg_temp_free_i64(tmp64);
6935 955a7dd5 balrog
                        if (rd != 15) {
6936 955a7dd5 balrog
                            tmp2 = load_reg(s, rd);
6937 9ee6e8bb pbrook
                            if (insn & (1 << 6)) {
6938 5e3f878a pbrook
                                tcg_gen_sub_i32(tmp, tmp, tmp2);
6939 9ee6e8bb pbrook
                            } else {
6940 5e3f878a pbrook
                                tcg_gen_add_i32(tmp, tmp, tmp2);
6941 9ee6e8bb pbrook
                            }
6942 5e3f878a pbrook
                            dead_tmp(tmp2);
6943 9ee6e8bb pbrook
                        }
6944 955a7dd5 balrog
                        store_reg(s, rn, tmp);
6945 9ee6e8bb pbrook
                    } else {
6946 9ee6e8bb pbrook
                        if (insn & (1 << 5))
6947 5e3f878a pbrook
                            gen_swap_half(tmp2);
6948 5e3f878a pbrook
                        gen_smul_dual(tmp, tmp2);
6949 5e3f878a pbrook
                        /* This addition cannot overflow.  */
6950 5e3f878a pbrook
                        if (insn & (1 << 6)) {
6951 5e3f878a pbrook
                            tcg_gen_sub_i32(tmp, tmp, tmp2);
6952 5e3f878a pbrook
                        } else {
6953 5e3f878a pbrook
                            tcg_gen_add_i32(tmp, tmp, tmp2);
6954 5e3f878a pbrook
                        }
6955 5e3f878a pbrook
                        dead_tmp(tmp2);
6956 9ee6e8bb pbrook
                        if (insn & (1 << 22)) {
6957 5e3f878a pbrook
                            /* smlald, smlsld */
6958 a7812ae4 pbrook
                            tmp64 = tcg_temp_new_i64();
6959 a7812ae4 pbrook
                            tcg_gen_ext_i32_i64(tmp64, tmp);
6960 5e3f878a pbrook
                            dead_tmp(tmp);
6961 a7812ae4 pbrook
                            gen_addq(s, tmp64, rd, rn);
6962 a7812ae4 pbrook
                            gen_storeq_reg(s, rd, rn, tmp64);
6963 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i64(tmp64);
6964 9ee6e8bb pbrook
                        } else {
6965 5e3f878a pbrook
                            /* smuad, smusd, smlad, smlsd */
6966 22478e79 balrog
                            if (rd != 15)
6967 9ee6e8bb pbrook
                              {
6968 22478e79 balrog
                                tmp2 = load_reg(s, rd);
6969 5e3f878a pbrook
                                gen_helper_add_setq(tmp, tmp, tmp2);
6970 5e3f878a pbrook
                                dead_tmp(tmp2);
6971 9ee6e8bb pbrook
                              }
6972 22478e79 balrog
                            store_reg(s, rn, tmp);
6973 9ee6e8bb pbrook
                        }
6974 9ee6e8bb pbrook
                    }
6975 9ee6e8bb pbrook
                    break;
6976 9ee6e8bb pbrook
                case 3:
6977 9ee6e8bb pbrook
                    op1 = ((insn >> 17) & 0x38) | ((insn >> 5) & 7);
6978 9ee6e8bb pbrook
                    switch (op1) {
6979 9ee6e8bb pbrook
                    case 0: /* Unsigned sum of absolute differences.  */
6980 6ddbc6e4 pbrook
                        ARCH(6);
6981 6ddbc6e4 pbrook
                        tmp = load_reg(s, rm);
6982 6ddbc6e4 pbrook
                        tmp2 = load_reg(s, rs);
6983 6ddbc6e4 pbrook
                        gen_helper_usad8(tmp, tmp, tmp2);
6984 6ddbc6e4 pbrook
                        dead_tmp(tmp2);
6985 ded9d295 balrog
                        if (rd != 15) {
6986 ded9d295 balrog
                            tmp2 = load_reg(s, rd);
6987 6ddbc6e4 pbrook
                            tcg_gen_add_i32(tmp, tmp, tmp2);
6988 6ddbc6e4 pbrook
                            dead_tmp(tmp2);
6989 9ee6e8bb pbrook
                        }
6990 ded9d295 balrog
                        store_reg(s, rn, tmp);
6991 9ee6e8bb pbrook
                        break;
6992 9ee6e8bb pbrook
                    case 0x20: case 0x24: case 0x28: case 0x2c:
6993 9ee6e8bb pbrook
                        /* Bitfield insert/clear.  */
6994 9ee6e8bb pbrook
                        ARCH(6T2);
6995 9ee6e8bb pbrook
                        shift = (insn >> 7) & 0x1f;
6996 9ee6e8bb pbrook
                        i = (insn >> 16) & 0x1f;
6997 9ee6e8bb pbrook
                        i = i + 1 - shift;
6998 9ee6e8bb pbrook
                        if (rm == 15) {
6999 5e3f878a pbrook
                            tmp = new_tmp();
7000 5e3f878a pbrook
                            tcg_gen_movi_i32(tmp, 0);
7001 9ee6e8bb pbrook
                        } else {
7002 5e3f878a pbrook
                            tmp = load_reg(s, rm);
7003 9ee6e8bb pbrook
                        }
7004 9ee6e8bb pbrook
                        if (i != 32) {
7005 5e3f878a pbrook
                            tmp2 = load_reg(s, rd);
7006 8f8e3aa4 pbrook
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << i) - 1);
7007 5e3f878a pbrook
                            dead_tmp(tmp2);
7008 9ee6e8bb pbrook
                        }
7009 5e3f878a pbrook
                        store_reg(s, rd, tmp);
7010 9ee6e8bb pbrook
                        break;
7011 9ee6e8bb pbrook
                    case 0x12: case 0x16: case 0x1a: case 0x1e: /* sbfx */
7012 9ee6e8bb pbrook
                    case 0x32: case 0x36: case 0x3a: case 0x3e: /* ubfx */
7013 4cc633c3 balrog
                        ARCH(6T2);
7014 5e3f878a pbrook
                        tmp = load_reg(s, rm);
7015 9ee6e8bb pbrook
                        shift = (insn >> 7) & 0x1f;
7016 9ee6e8bb pbrook
                        i = ((insn >> 16) & 0x1f) + 1;
7017 9ee6e8bb pbrook
                        if (shift + i > 32)
7018 9ee6e8bb pbrook
                            goto illegal_op;
7019 9ee6e8bb pbrook
                        if (i < 32) {
7020 9ee6e8bb pbrook
                            if (op1 & 0x20) {
7021 5e3f878a pbrook
                                gen_ubfx(tmp, shift, (1u << i) - 1);
7022 9ee6e8bb pbrook
                            } else {
7023 5e3f878a pbrook
                                gen_sbfx(tmp, shift, i);
7024 9ee6e8bb pbrook
                            }
7025 9ee6e8bb pbrook
                        }
7026 5e3f878a pbrook
                        store_reg(s, rd, tmp);
7027 9ee6e8bb pbrook
                        break;
7028 9ee6e8bb pbrook
                    default:
7029 9ee6e8bb pbrook
                        goto illegal_op;
7030 9ee6e8bb pbrook
                    }
7031 9ee6e8bb pbrook
                    break;
7032 9ee6e8bb pbrook
                }
7033 9ee6e8bb pbrook
                break;
7034 9ee6e8bb pbrook
            }
7035 9ee6e8bb pbrook
        do_ldst:
7036 9ee6e8bb pbrook
            /* Check for undefined extension instructions
7037 9ee6e8bb pbrook
             * per the ARM Bible IE:
7038 9ee6e8bb pbrook
             * xxxx 0111 1111 xxxx  xxxx xxxx 1111 xxxx
7039 9ee6e8bb pbrook
             */
7040 9ee6e8bb pbrook
            sh = (0xf << 20) | (0xf << 4);
7041 9ee6e8bb pbrook
            if (op1 == 0x7 && ((insn & sh) == sh))
7042 9ee6e8bb pbrook
            {
7043 9ee6e8bb pbrook
                goto illegal_op;
7044 9ee6e8bb pbrook
            }
7045 9ee6e8bb pbrook
            /* load/store byte/word */
7046 9ee6e8bb pbrook
            rn = (insn >> 16) & 0xf;
7047 9ee6e8bb pbrook
            rd = (insn >> 12) & 0xf;
7048 b0109805 pbrook
            tmp2 = load_reg(s, rn);
7049 9ee6e8bb pbrook
            i = (IS_USER(s) || (insn & 0x01200000) == 0x00200000);
7050 9ee6e8bb pbrook
            if (insn & (1 << 24))
7051 b0109805 pbrook
                gen_add_data_offset(s, insn, tmp2);
7052 9ee6e8bb pbrook
            if (insn & (1 << 20)) {
7053 9ee6e8bb pbrook
                /* load */
7054 9ee6e8bb pbrook
                if (insn & (1 << 22)) {
7055 b0109805 pbrook
                    tmp = gen_ld8u(tmp2, i);
7056 9ee6e8bb pbrook
                } else {
7057 b0109805 pbrook
                    tmp = gen_ld32(tmp2, i);
7058 9ee6e8bb pbrook
                }
7059 9ee6e8bb pbrook
            } else {
7060 9ee6e8bb pbrook
                /* store */
7061 b0109805 pbrook
                tmp = load_reg(s, rd);
7062 9ee6e8bb pbrook
                if (insn & (1 << 22))
7063 b0109805 pbrook
                    gen_st8(tmp, tmp2, i);
7064 9ee6e8bb pbrook
                else
7065 b0109805 pbrook
                    gen_st32(tmp, tmp2, i);
7066 9ee6e8bb pbrook
            }
7067 9ee6e8bb pbrook
            if (!(insn & (1 << 24))) {
7068 b0109805 pbrook
                gen_add_data_offset(s, insn, tmp2);
7069 b0109805 pbrook
                store_reg(s, rn, tmp2);
7070 b0109805 pbrook
            } else if (insn & (1 << 21)) {
7071 b0109805 pbrook
                store_reg(s, rn, tmp2);
7072 b0109805 pbrook
            } else {
7073 b0109805 pbrook
                dead_tmp(tmp2);
7074 9ee6e8bb pbrook
            }
7075 9ee6e8bb pbrook
            if (insn & (1 << 20)) {
7076 9ee6e8bb pbrook
                /* Complete the load.  */
7077 9ee6e8bb pbrook
                if (rd == 15)
7078 b0109805 pbrook
                    gen_bx(s, tmp);
7079 9ee6e8bb pbrook
                else
7080 b0109805 pbrook
                    store_reg(s, rd, tmp);
7081 9ee6e8bb pbrook
            }
7082 9ee6e8bb pbrook
            break;
7083 9ee6e8bb pbrook
        case 0x08:
7084 9ee6e8bb pbrook
        case 0x09:
7085 9ee6e8bb pbrook
            {
7086 9ee6e8bb pbrook
                int j, n, user, loaded_base;
7087 b0109805 pbrook
                TCGv loaded_var;
7088 9ee6e8bb pbrook
                /* load/store multiple words */
7089 9ee6e8bb pbrook
                /* XXX: store correct base if write back */
7090 9ee6e8bb pbrook
                user = 0;
7091 9ee6e8bb pbrook
                if (insn & (1 << 22)) {
7092 9ee6e8bb pbrook
                    if (IS_USER(s))
7093 9ee6e8bb pbrook
                        goto illegal_op; /* only usable in supervisor mode */
7094 9ee6e8bb pbrook
7095 9ee6e8bb pbrook
                    if ((insn & (1 << 15)) == 0)
7096 9ee6e8bb pbrook
                        user = 1;
7097 9ee6e8bb pbrook
                }
7098 9ee6e8bb pbrook
                rn = (insn >> 16) & 0xf;
7099 b0109805 pbrook
                addr = load_reg(s, rn);
7100 9ee6e8bb pbrook
7101 9ee6e8bb pbrook
                /* compute total size */
7102 9ee6e8bb pbrook
                loaded_base = 0;
7103 a50f5b91 pbrook
                TCGV_UNUSED(loaded_var);
7104 9ee6e8bb pbrook
                n = 0;
7105 9ee6e8bb pbrook
                for(i=0;i<16;i++) {
7106 9ee6e8bb pbrook
                    if (insn & (1 << i))
7107 9ee6e8bb pbrook
                        n++;
7108 9ee6e8bb pbrook
                }
7109 9ee6e8bb pbrook
                /* XXX: test invalid n == 0 case ? */
7110 9ee6e8bb pbrook
                if (insn & (1 << 23)) {
7111 9ee6e8bb pbrook
                    if (insn & (1 << 24)) {
7112 9ee6e8bb pbrook
                        /* pre increment */
7113 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, 4);
7114 9ee6e8bb pbrook
                    } else {
7115 9ee6e8bb pbrook
                        /* post increment */
7116 9ee6e8bb pbrook
                    }
7117 9ee6e8bb pbrook
                } else {
7118 9ee6e8bb pbrook
                    if (insn & (1 << 24)) {
7119 9ee6e8bb pbrook
                        /* pre decrement */
7120 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, -(n * 4));
7121 9ee6e8bb pbrook
                    } else {
7122 9ee6e8bb pbrook
                        /* post decrement */
7123 9ee6e8bb pbrook
                        if (n != 1)
7124 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
7125 9ee6e8bb pbrook
                    }
7126 9ee6e8bb pbrook
                }
7127 9ee6e8bb pbrook
                j = 0;
7128 9ee6e8bb pbrook
                for(i=0;i<16;i++) {
7129 9ee6e8bb pbrook
                    if (insn & (1 << i)) {
7130 9ee6e8bb pbrook
                        if (insn & (1 << 20)) {
7131 9ee6e8bb pbrook
                            /* load */
7132 b0109805 pbrook
                            tmp = gen_ld32(addr, IS_USER(s));
7133 9ee6e8bb pbrook
                            if (i == 15) {
7134 b0109805 pbrook
                                gen_bx(s, tmp);
7135 9ee6e8bb pbrook
                            } else if (user) {
7136 b75263d6 Juha Riihimรคki
                                tmp2 = tcg_const_i32(i);
7137 b75263d6 Juha Riihimรคki
                                gen_helper_set_user_reg(tmp2, tmp);
7138 b75263d6 Juha Riihimรคki
                                tcg_temp_free_i32(tmp2);
7139 b0109805 pbrook
                                dead_tmp(tmp);
7140 9ee6e8bb pbrook
                            } else if (i == rn) {
7141 b0109805 pbrook
                                loaded_var = tmp;
7142 9ee6e8bb pbrook
                                loaded_base = 1;
7143 9ee6e8bb pbrook
                            } else {
7144 b0109805 pbrook
                                store_reg(s, i, tmp);
7145 9ee6e8bb pbrook
                            }
7146 9ee6e8bb pbrook
                        } else {
7147 9ee6e8bb pbrook
                            /* store */
7148 9ee6e8bb pbrook
                            if (i == 15) {
7149 9ee6e8bb pbrook
                                /* special case: r15 = PC + 8 */
7150 9ee6e8bb pbrook
                                val = (long)s->pc + 4;
7151 b0109805 pbrook
                                tmp = new_tmp();
7152 b0109805 pbrook
                                tcg_gen_movi_i32(tmp, val);
7153 9ee6e8bb pbrook
                            } else if (user) {
7154 b0109805 pbrook
                                tmp = new_tmp();
7155 b75263d6 Juha Riihimรคki
                                tmp2 = tcg_const_i32(i);
7156 b75263d6 Juha Riihimรคki
                                gen_helper_get_user_reg(tmp, tmp2);
7157 b75263d6 Juha Riihimรคki
                                tcg_temp_free_i32(tmp2);
7158 9ee6e8bb pbrook
                            } else {
7159 b0109805 pbrook
                                tmp = load_reg(s, i);
7160 9ee6e8bb pbrook
                            }
7161 b0109805 pbrook
                            gen_st32(tmp, addr, IS_USER(s));
7162 9ee6e8bb pbrook
                        }
7163 9ee6e8bb pbrook
                        j++;
7164 9ee6e8bb pbrook
                        /* no need to add after the last transfer */
7165 9ee6e8bb pbrook
                        if (j != n)
7166 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, 4);
7167 9ee6e8bb pbrook
                    }
7168 9ee6e8bb pbrook
                }
7169 9ee6e8bb pbrook
                if (insn & (1 << 21)) {
7170 9ee6e8bb pbrook
                    /* write back */
7171 9ee6e8bb pbrook
                    if (insn & (1 << 23)) {
7172 9ee6e8bb pbrook
                        if (insn & (1 << 24)) {
7173 9ee6e8bb pbrook
                            /* pre increment */
7174 9ee6e8bb pbrook
                        } else {
7175 9ee6e8bb pbrook
                            /* post increment */
7176 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, 4);
7177 9ee6e8bb pbrook
                        }
7178 9ee6e8bb pbrook
                    } else {
7179 9ee6e8bb pbrook
                        if (insn & (1 << 24)) {
7180 9ee6e8bb pbrook
                            /* pre decrement */
7181 9ee6e8bb pbrook
                            if (n != 1)
7182 b0109805 pbrook
                                tcg_gen_addi_i32(addr, addr, -((n - 1) * 4));
7183 9ee6e8bb pbrook
                        } else {
7184 9ee6e8bb pbrook
                            /* post decrement */
7185 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, -(n * 4));
7186 9ee6e8bb pbrook
                        }
7187 9ee6e8bb pbrook
                    }
7188 b0109805 pbrook
                    store_reg(s, rn, addr);
7189 b0109805 pbrook
                } else {
7190 b0109805 pbrook
                    dead_tmp(addr);
7191 9ee6e8bb pbrook
                }
7192 9ee6e8bb pbrook
                if (loaded_base) {
7193 b0109805 pbrook
                    store_reg(s, rn, loaded_var);
7194 9ee6e8bb pbrook
                }
7195 9ee6e8bb pbrook
                if ((insn & (1 << 22)) && !user) {
7196 9ee6e8bb pbrook
                    /* Restore CPSR from SPSR.  */
7197 d9ba4830 pbrook
                    tmp = load_cpu_field(spsr);
7198 d9ba4830 pbrook
                    gen_set_cpsr(tmp, 0xffffffff);
7199 d9ba4830 pbrook
                    dead_tmp(tmp);
7200 9ee6e8bb pbrook
                    s->is_jmp = DISAS_UPDATE;
7201 9ee6e8bb pbrook
                }
7202 9ee6e8bb pbrook
            }
7203 9ee6e8bb pbrook
            break;
7204 9ee6e8bb pbrook
        case 0xa:
7205 9ee6e8bb pbrook
        case 0xb:
7206 9ee6e8bb pbrook
            {
7207 9ee6e8bb pbrook
                int32_t offset;
7208 9ee6e8bb pbrook
7209 9ee6e8bb pbrook
                /* branch (and link) */
7210 9ee6e8bb pbrook
                val = (int32_t)s->pc;
7211 9ee6e8bb pbrook
                if (insn & (1 << 24)) {
7212 5e3f878a pbrook
                    tmp = new_tmp();
7213 5e3f878a pbrook
                    tcg_gen_movi_i32(tmp, val);
7214 5e3f878a pbrook
                    store_reg(s, 14, tmp);
7215 9ee6e8bb pbrook
                }
7216 9ee6e8bb pbrook
                offset = (((int32_t)insn << 8) >> 8);
7217 9ee6e8bb pbrook
                val += (offset << 2) + 4;
7218 9ee6e8bb pbrook
                gen_jmp(s, val);
7219 9ee6e8bb pbrook
            }
7220 9ee6e8bb pbrook
            break;
7221 9ee6e8bb pbrook
        case 0xc:
7222 9ee6e8bb pbrook
        case 0xd:
7223 9ee6e8bb pbrook
        case 0xe:
7224 9ee6e8bb pbrook
            /* Coprocessor.  */
7225 9ee6e8bb pbrook
            if (disas_coproc_insn(env, s, insn))
7226 9ee6e8bb pbrook
                goto illegal_op;
7227 9ee6e8bb pbrook
            break;
7228 9ee6e8bb pbrook
        case 0xf:
7229 9ee6e8bb pbrook
            /* swi */
7230 5e3f878a pbrook
            gen_set_pc_im(s->pc);
7231 9ee6e8bb pbrook
            s->is_jmp = DISAS_SWI;
7232 9ee6e8bb pbrook
            break;
7233 9ee6e8bb pbrook
        default:
7234 9ee6e8bb pbrook
        illegal_op:
7235 9ee6e8bb pbrook
            gen_set_condexec(s);
7236 5e3f878a pbrook
            gen_set_pc_im(s->pc - 4);
7237 d9ba4830 pbrook
            gen_exception(EXCP_UDEF);
7238 9ee6e8bb pbrook
            s->is_jmp = DISAS_JUMP;
7239 9ee6e8bb pbrook
            break;
7240 9ee6e8bb pbrook
        }
7241 9ee6e8bb pbrook
    }
7242 9ee6e8bb pbrook
}
7243 9ee6e8bb pbrook
7244 9ee6e8bb pbrook
/* Return true if this is a Thumb-2 logical op.  */
7245 9ee6e8bb pbrook
static int
7246 9ee6e8bb pbrook
thumb2_logic_op(int op)
7247 9ee6e8bb pbrook
{
7248 9ee6e8bb pbrook
    return (op < 8);
7249 9ee6e8bb pbrook
}
7250 9ee6e8bb pbrook
7251 9ee6e8bb pbrook
/* Generate code for a Thumb-2 data processing operation.  If CONDS is nonzero
7252 9ee6e8bb pbrook
   then set condition code flags based on the result of the operation.
7253 9ee6e8bb pbrook
   If SHIFTER_OUT is nonzero then set the carry flag for logical operations
7254 9ee6e8bb pbrook
   to the high bit of T1.
7255 9ee6e8bb pbrook
   Returns zero if the opcode is valid.  */
7256 9ee6e8bb pbrook
7257 9ee6e8bb pbrook
static int
7258 396e467c Filip Navara
gen_thumb2_data_op(DisasContext *s, int op, int conds, uint32_t shifter_out, TCGv t0, TCGv t1)
7259 9ee6e8bb pbrook
{
7260 9ee6e8bb pbrook
    int logic_cc;
7261 9ee6e8bb pbrook
7262 9ee6e8bb pbrook
    logic_cc = 0;
7263 9ee6e8bb pbrook
    switch (op) {
7264 9ee6e8bb pbrook
    case 0: /* and */
7265 396e467c Filip Navara
        tcg_gen_and_i32(t0, t0, t1);
7266 9ee6e8bb pbrook
        logic_cc = conds;
7267 9ee6e8bb pbrook
        break;
7268 9ee6e8bb pbrook
    case 1: /* bic */
7269 f669df27 Aurelien Jarno
        tcg_gen_andc_i32(t0, t0, t1);
7270 9ee6e8bb pbrook
        logic_cc = conds;
7271 9ee6e8bb pbrook
        break;
7272 9ee6e8bb pbrook
    case 2: /* orr */
7273 396e467c Filip Navara
        tcg_gen_or_i32(t0, t0, t1);
7274 9ee6e8bb pbrook
        logic_cc = conds;
7275 9ee6e8bb pbrook
        break;
7276 9ee6e8bb pbrook
    case 3: /* orn */
7277 396e467c Filip Navara
        tcg_gen_not_i32(t1, t1);
7278 396e467c Filip Navara
        tcg_gen_or_i32(t0, t0, t1);
7279 9ee6e8bb pbrook
        logic_cc = conds;
7280 9ee6e8bb pbrook
        break;
7281 9ee6e8bb pbrook
    case 4: /* eor */
7282 396e467c Filip Navara
        tcg_gen_xor_i32(t0, t0, t1);
7283 9ee6e8bb pbrook
        logic_cc = conds;
7284 9ee6e8bb pbrook
        break;
7285 9ee6e8bb pbrook
    case 8: /* add */
7286 9ee6e8bb pbrook
        if (conds)
7287 396e467c Filip Navara
            gen_helper_add_cc(t0, t0, t1);
7288 9ee6e8bb pbrook
        else
7289 396e467c Filip Navara
            tcg_gen_add_i32(t0, t0, t1);
7290 9ee6e8bb pbrook
        break;
7291 9ee6e8bb pbrook
    case 10: /* adc */
7292 9ee6e8bb pbrook
        if (conds)
7293 396e467c Filip Navara
            gen_helper_adc_cc(t0, t0, t1);
7294 9ee6e8bb pbrook
        else
7295 396e467c Filip Navara
            gen_adc(t0, t1);
7296 9ee6e8bb pbrook
        break;
7297 9ee6e8bb pbrook
    case 11: /* sbc */
7298 9ee6e8bb pbrook
        if (conds)
7299 396e467c Filip Navara
            gen_helper_sbc_cc(t0, t0, t1);
7300 9ee6e8bb pbrook
        else
7301 396e467c Filip Navara
            gen_sub_carry(t0, t0, t1);
7302 9ee6e8bb pbrook
        break;
7303 9ee6e8bb pbrook
    case 13: /* sub */
7304 9ee6e8bb pbrook
        if (conds)
7305 396e467c Filip Navara
            gen_helper_sub_cc(t0, t0, t1);
7306 9ee6e8bb pbrook
        else
7307 396e467c Filip Navara
            tcg_gen_sub_i32(t0, t0, t1);
7308 9ee6e8bb pbrook
        break;
7309 9ee6e8bb pbrook
    case 14: /* rsb */
7310 9ee6e8bb pbrook
        if (conds)
7311 396e467c Filip Navara
            gen_helper_sub_cc(t0, t1, t0);
7312 9ee6e8bb pbrook
        else
7313 396e467c Filip Navara
            tcg_gen_sub_i32(t0, t1, t0);
7314 9ee6e8bb pbrook
        break;
7315 9ee6e8bb pbrook
    default: /* 5, 6, 7, 9, 12, 15. */
7316 9ee6e8bb pbrook
        return 1;
7317 9ee6e8bb pbrook
    }
7318 9ee6e8bb pbrook
    if (logic_cc) {
7319 396e467c Filip Navara
        gen_logic_CC(t0);
7320 9ee6e8bb pbrook
        if (shifter_out)
7321 396e467c Filip Navara
            gen_set_CF_bit31(t1);
7322 9ee6e8bb pbrook
    }
7323 9ee6e8bb pbrook
    return 0;
7324 9ee6e8bb pbrook
}
7325 9ee6e8bb pbrook
7326 9ee6e8bb pbrook
/* Translate a 32-bit thumb instruction.  Returns nonzero if the instruction
7327 9ee6e8bb pbrook
   is not legal.  */
7328 9ee6e8bb pbrook
static int disas_thumb2_insn(CPUState *env, DisasContext *s, uint16_t insn_hw1)
7329 9ee6e8bb pbrook
{
7330 b0109805 pbrook
    uint32_t insn, imm, shift, offset;
7331 9ee6e8bb pbrook
    uint32_t rd, rn, rm, rs;
7332 b26eefb6 pbrook
    TCGv tmp;
7333 6ddbc6e4 pbrook
    TCGv tmp2;
7334 6ddbc6e4 pbrook
    TCGv tmp3;
7335 b0109805 pbrook
    TCGv addr;
7336 a7812ae4 pbrook
    TCGv_i64 tmp64;
7337 9ee6e8bb pbrook
    int op;
7338 9ee6e8bb pbrook
    int shiftop;
7339 9ee6e8bb pbrook
    int conds;
7340 9ee6e8bb pbrook
    int logic_cc;
7341 9ee6e8bb pbrook
7342 9ee6e8bb pbrook
    if (!(arm_feature(env, ARM_FEATURE_THUMB2)
7343 9ee6e8bb pbrook
          || arm_feature (env, ARM_FEATURE_M))) {
7344 601d70b9 balrog
        /* Thumb-1 cores may need to treat bl and blx as a pair of
7345 9ee6e8bb pbrook
           16-bit instructions to get correct prefetch abort behavior.  */
7346 9ee6e8bb pbrook
        insn = insn_hw1;
7347 9ee6e8bb pbrook
        if ((insn & (1 << 12)) == 0) {
7348 9ee6e8bb pbrook
            /* Second half of blx.  */
7349 9ee6e8bb pbrook
            offset = ((insn & 0x7ff) << 1);
7350 d9ba4830 pbrook
            tmp = load_reg(s, 14);
7351 d9ba4830 pbrook
            tcg_gen_addi_i32(tmp, tmp, offset);
7352 d9ba4830 pbrook
            tcg_gen_andi_i32(tmp, tmp, 0xfffffffc);
7353 9ee6e8bb pbrook
7354 d9ba4830 pbrook
            tmp2 = new_tmp();
7355 b0109805 pbrook
            tcg_gen_movi_i32(tmp2, s->pc | 1);
7356 d9ba4830 pbrook
            store_reg(s, 14, tmp2);
7357 d9ba4830 pbrook
            gen_bx(s, tmp);
7358 9ee6e8bb pbrook
            return 0;
7359 9ee6e8bb pbrook
        }
7360 9ee6e8bb pbrook
        if (insn & (1 << 11)) {
7361 9ee6e8bb pbrook
            /* Second half of bl.  */
7362 9ee6e8bb pbrook
            offset = ((insn & 0x7ff) << 1) | 1;
7363 d9ba4830 pbrook
            tmp = load_reg(s, 14);
7364 6a0d8a1d balrog
            tcg_gen_addi_i32(tmp, tmp, offset);
7365 9ee6e8bb pbrook
7366 d9ba4830 pbrook
            tmp2 = new_tmp();
7367 b0109805 pbrook
            tcg_gen_movi_i32(tmp2, s->pc | 1);
7368 d9ba4830 pbrook
            store_reg(s, 14, tmp2);
7369 d9ba4830 pbrook
            gen_bx(s, tmp);
7370 9ee6e8bb pbrook
            return 0;
7371 9ee6e8bb pbrook
        }
7372 9ee6e8bb pbrook
        if ((s->pc & ~TARGET_PAGE_MASK) == 0) {
7373 9ee6e8bb pbrook
            /* Instruction spans a page boundary.  Implement it as two
7374 9ee6e8bb pbrook
               16-bit instructions in case the second half causes an
7375 9ee6e8bb pbrook
               prefetch abort.  */
7376 9ee6e8bb pbrook
            offset = ((int32_t)insn << 21) >> 9;
7377 396e467c Filip Navara
            tcg_gen_movi_i32(cpu_R[14], s->pc + 2 + offset);
7378 9ee6e8bb pbrook
            return 0;
7379 9ee6e8bb pbrook
        }
7380 9ee6e8bb pbrook
        /* Fall through to 32-bit decode.  */
7381 9ee6e8bb pbrook
    }
7382 9ee6e8bb pbrook
7383 9ee6e8bb pbrook
    insn = lduw_code(s->pc);
7384 9ee6e8bb pbrook
    s->pc += 2;
7385 9ee6e8bb pbrook
    insn |= (uint32_t)insn_hw1 << 16;
7386 9ee6e8bb pbrook
7387 9ee6e8bb pbrook
    if ((insn & 0xf800e800) != 0xf000e800) {
7388 9ee6e8bb pbrook
        ARCH(6T2);
7389 9ee6e8bb pbrook
    }
7390 9ee6e8bb pbrook
7391 9ee6e8bb pbrook
    rn = (insn >> 16) & 0xf;
7392 9ee6e8bb pbrook
    rs = (insn >> 12) & 0xf;
7393 9ee6e8bb pbrook
    rd = (insn >> 8) & 0xf;
7394 9ee6e8bb pbrook
    rm = insn & 0xf;
7395 9ee6e8bb pbrook
    switch ((insn >> 25) & 0xf) {
7396 9ee6e8bb pbrook
    case 0: case 1: case 2: case 3:
7397 9ee6e8bb pbrook
        /* 16-bit instructions.  Should never happen.  */
7398 9ee6e8bb pbrook
        abort();
7399 9ee6e8bb pbrook
    case 4:
7400 9ee6e8bb pbrook
        if (insn & (1 << 22)) {
7401 9ee6e8bb pbrook
            /* Other load/store, table branch.  */
7402 9ee6e8bb pbrook
            if (insn & 0x01200000) {
7403 9ee6e8bb pbrook
                /* Load/store doubleword.  */
7404 9ee6e8bb pbrook
                if (rn == 15) {
7405 b0109805 pbrook
                    addr = new_tmp();
7406 b0109805 pbrook
                    tcg_gen_movi_i32(addr, s->pc & ~3);
7407 9ee6e8bb pbrook
                } else {
7408 b0109805 pbrook
                    addr = load_reg(s, rn);
7409 9ee6e8bb pbrook
                }
7410 9ee6e8bb pbrook
                offset = (insn & 0xff) * 4;
7411 9ee6e8bb pbrook
                if ((insn & (1 << 23)) == 0)
7412 9ee6e8bb pbrook
                    offset = -offset;
7413 9ee6e8bb pbrook
                if (insn & (1 << 24)) {
7414 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, offset);
7415 9ee6e8bb pbrook
                    offset = 0;
7416 9ee6e8bb pbrook
                }
7417 9ee6e8bb pbrook
                if (insn & (1 << 20)) {
7418 9ee6e8bb pbrook
                    /* ldrd */
7419 b0109805 pbrook
                    tmp = gen_ld32(addr, IS_USER(s));
7420 b0109805 pbrook
                    store_reg(s, rs, tmp);
7421 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
7422 b0109805 pbrook
                    tmp = gen_ld32(addr, IS_USER(s));
7423 b0109805 pbrook
                    store_reg(s, rd, tmp);
7424 9ee6e8bb pbrook
                } else {
7425 9ee6e8bb pbrook
                    /* strd */
7426 b0109805 pbrook
                    tmp = load_reg(s, rs);
7427 b0109805 pbrook
                    gen_st32(tmp, addr, IS_USER(s));
7428 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
7429 b0109805 pbrook
                    tmp = load_reg(s, rd);
7430 b0109805 pbrook
                    gen_st32(tmp, addr, IS_USER(s));
7431 9ee6e8bb pbrook
                }
7432 9ee6e8bb pbrook
                if (insn & (1 << 21)) {
7433 9ee6e8bb pbrook
                    /* Base writeback.  */
7434 9ee6e8bb pbrook
                    if (rn == 15)
7435 9ee6e8bb pbrook
                        goto illegal_op;
7436 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, offset - 4);
7437 b0109805 pbrook
                    store_reg(s, rn, addr);
7438 b0109805 pbrook
                } else {
7439 b0109805 pbrook
                    dead_tmp(addr);
7440 9ee6e8bb pbrook
                }
7441 9ee6e8bb pbrook
            } else if ((insn & (1 << 23)) == 0) {
7442 9ee6e8bb pbrook
                /* Load/store exclusive word.  */
7443 3174f8e9 Filip Navara
                addr = tcg_temp_local_new();
7444 98a46317 Aurelien Jarno
                load_reg_var(s, addr, rn);
7445 426f5abc Paul Brook
                tcg_gen_addi_i32(addr, addr, (insn & 0xff) << 2);
7446 2c0262af bellard
                if (insn & (1 << 20)) {
7447 426f5abc Paul Brook
                    gen_load_exclusive(s, rs, 15, addr, 2);
7448 9ee6e8bb pbrook
                } else {
7449 426f5abc Paul Brook
                    gen_store_exclusive(s, rd, rs, 15, addr, 2);
7450 9ee6e8bb pbrook
                }
7451 3174f8e9 Filip Navara
                tcg_temp_free(addr);
7452 9ee6e8bb pbrook
            } else if ((insn & (1 << 6)) == 0) {
7453 9ee6e8bb pbrook
                /* Table Branch.  */
7454 9ee6e8bb pbrook
                if (rn == 15) {
7455 b0109805 pbrook
                    addr = new_tmp();
7456 b0109805 pbrook
                    tcg_gen_movi_i32(addr, s->pc);
7457 9ee6e8bb pbrook
                } else {
7458 b0109805 pbrook
                    addr = load_reg(s, rn);
7459 9ee6e8bb pbrook
                }
7460 b26eefb6 pbrook
                tmp = load_reg(s, rm);
7461 b0109805 pbrook
                tcg_gen_add_i32(addr, addr, tmp);
7462 9ee6e8bb pbrook
                if (insn & (1 << 4)) {
7463 9ee6e8bb pbrook
                    /* tbh */
7464 b0109805 pbrook
                    tcg_gen_add_i32(addr, addr, tmp);
7465 b26eefb6 pbrook
                    dead_tmp(tmp);
7466 b0109805 pbrook
                    tmp = gen_ld16u(addr, IS_USER(s));
7467 9ee6e8bb pbrook
                } else { /* tbb */
7468 b26eefb6 pbrook
                    dead_tmp(tmp);
7469 b0109805 pbrook
                    tmp = gen_ld8u(addr, IS_USER(s));
7470 9ee6e8bb pbrook
                }
7471 b0109805 pbrook
                dead_tmp(addr);
7472 b0109805 pbrook
                tcg_gen_shli_i32(tmp, tmp, 1);
7473 b0109805 pbrook
                tcg_gen_addi_i32(tmp, tmp, s->pc);
7474 b0109805 pbrook
                store_reg(s, 15, tmp);
7475 9ee6e8bb pbrook
            } else {
7476 9ee6e8bb pbrook
                /* Load/store exclusive byte/halfword/doubleword.  */
7477 426f5abc Paul Brook
                ARCH(7);
7478 9ee6e8bb pbrook
                op = (insn >> 4) & 0x3;
7479 426f5abc Paul Brook
                if (op == 2) {
7480 426f5abc Paul Brook
                    goto illegal_op;
7481 426f5abc Paul Brook
                }
7482 3174f8e9 Filip Navara
                addr = tcg_temp_local_new();
7483 98a46317 Aurelien Jarno
                load_reg_var(s, addr, rn);
7484 9ee6e8bb pbrook
                if (insn & (1 << 20)) {
7485 426f5abc Paul Brook
                    gen_load_exclusive(s, rs, rd, addr, op);
7486 9ee6e8bb pbrook
                } else {
7487 426f5abc Paul Brook
                    gen_store_exclusive(s, rm, rs, rd, addr, op);
7488 9ee6e8bb pbrook
                }
7489 3174f8e9 Filip Navara
                tcg_temp_free(addr);
7490 9ee6e8bb pbrook
            }
7491 9ee6e8bb pbrook
        } else {
7492 9ee6e8bb pbrook
            /* Load/store multiple, RFE, SRS.  */
7493 9ee6e8bb pbrook
            if (((insn >> 23) & 1) == ((insn >> 24) & 1)) {
7494 9ee6e8bb pbrook
                /* Not available in user mode.  */
7495 b0109805 pbrook
                if (IS_USER(s))
7496 9ee6e8bb pbrook
                    goto illegal_op;
7497 9ee6e8bb pbrook
                if (insn & (1 << 20)) {
7498 9ee6e8bb pbrook
                    /* rfe */
7499 b0109805 pbrook
                    addr = load_reg(s, rn);
7500 b0109805 pbrook
                    if ((insn & (1 << 24)) == 0)
7501 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, -8);
7502 b0109805 pbrook
                    /* Load PC into tmp and CPSR into tmp2.  */
7503 b0109805 pbrook
                    tmp = gen_ld32(addr, 0);
7504 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
7505 b0109805 pbrook
                    tmp2 = gen_ld32(addr, 0);
7506 9ee6e8bb pbrook
                    if (insn & (1 << 21)) {
7507 9ee6e8bb pbrook
                        /* Base writeback.  */
7508 b0109805 pbrook
                        if (insn & (1 << 24)) {
7509 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, 4);
7510 b0109805 pbrook
                        } else {
7511 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, -4);
7512 b0109805 pbrook
                        }
7513 b0109805 pbrook
                        store_reg(s, rn, addr);
7514 b0109805 pbrook
                    } else {
7515 b0109805 pbrook
                        dead_tmp(addr);
7516 9ee6e8bb pbrook
                    }
7517 b0109805 pbrook
                    gen_rfe(s, tmp, tmp2);
7518 9ee6e8bb pbrook
                } else {
7519 9ee6e8bb pbrook
                    /* srs */
7520 9ee6e8bb pbrook
                    op = (insn & 0x1f);
7521 9ee6e8bb pbrook
                    if (op == (env->uncached_cpsr & CPSR_M)) {
7522 b0109805 pbrook
                        addr = load_reg(s, 13);
7523 9ee6e8bb pbrook
                    } else {
7524 b0109805 pbrook
                        addr = new_tmp();
7525 b75263d6 Juha Riihimรคki
                        tmp = tcg_const_i32(op);
7526 b75263d6 Juha Riihimรคki
                        gen_helper_get_r13_banked(addr, cpu_env, tmp);
7527 b75263d6 Juha Riihimรคki
                        tcg_temp_free_i32(tmp);
7528 9ee6e8bb pbrook
                    }
7529 9ee6e8bb pbrook
                    if ((insn & (1 << 24)) == 0) {
7530 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, -8);
7531 9ee6e8bb pbrook
                    }
7532 b0109805 pbrook
                    tmp = load_reg(s, 14);
7533 b0109805 pbrook
                    gen_st32(tmp, addr, 0);
7534 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
7535 b0109805 pbrook
                    tmp = new_tmp();
7536 b0109805 pbrook
                    gen_helper_cpsr_read(tmp);
7537 b0109805 pbrook
                    gen_st32(tmp, addr, 0);
7538 9ee6e8bb pbrook
                    if (insn & (1 << 21)) {
7539 9ee6e8bb pbrook
                        if ((insn & (1 << 24)) == 0) {
7540 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, -4);
7541 9ee6e8bb pbrook
                        } else {
7542 b0109805 pbrook
                            tcg_gen_addi_i32(addr, addr, 4);
7543 9ee6e8bb pbrook
                        }
7544 9ee6e8bb pbrook
                        if (op == (env->uncached_cpsr & CPSR_M)) {
7545 b0109805 pbrook
                            store_reg(s, 13, addr);
7546 9ee6e8bb pbrook
                        } else {
7547 b75263d6 Juha Riihimรคki
                            tmp = tcg_const_i32(op);
7548 b75263d6 Juha Riihimรคki
                            gen_helper_set_r13_banked(cpu_env, tmp, addr);
7549 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i32(tmp);
7550 9ee6e8bb pbrook
                        }
7551 b0109805 pbrook
                    } else {
7552 b0109805 pbrook
                        dead_tmp(addr);
7553 9ee6e8bb pbrook
                    }
7554 9ee6e8bb pbrook
                }
7555 9ee6e8bb pbrook
            } else {
7556 9ee6e8bb pbrook
                int i;
7557 9ee6e8bb pbrook
                /* Load/store multiple.  */
7558 b0109805 pbrook
                addr = load_reg(s, rn);
7559 9ee6e8bb pbrook
                offset = 0;
7560 9ee6e8bb pbrook
                for (i = 0; i < 16; i++) {
7561 9ee6e8bb pbrook
                    if (insn & (1 << i))
7562 9ee6e8bb pbrook
                        offset += 4;
7563 9ee6e8bb pbrook
                }
7564 9ee6e8bb pbrook
                if (insn & (1 << 24)) {
7565 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, -offset);
7566 9ee6e8bb pbrook
                }
7567 9ee6e8bb pbrook
7568 9ee6e8bb pbrook
                for (i = 0; i < 16; i++) {
7569 9ee6e8bb pbrook
                    if ((insn & (1 << i)) == 0)
7570 9ee6e8bb pbrook
                        continue;
7571 9ee6e8bb pbrook
                    if (insn & (1 << 20)) {
7572 9ee6e8bb pbrook
                        /* Load.  */
7573 b0109805 pbrook
                        tmp = gen_ld32(addr, IS_USER(s));
7574 9ee6e8bb pbrook
                        if (i == 15) {
7575 b0109805 pbrook
                            gen_bx(s, tmp);
7576 9ee6e8bb pbrook
                        } else {
7577 b0109805 pbrook
                            store_reg(s, i, tmp);
7578 9ee6e8bb pbrook
                        }
7579 9ee6e8bb pbrook
                    } else {
7580 9ee6e8bb pbrook
                        /* Store.  */
7581 b0109805 pbrook
                        tmp = load_reg(s, i);
7582 b0109805 pbrook
                        gen_st32(tmp, addr, IS_USER(s));
7583 9ee6e8bb pbrook
                    }
7584 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
7585 9ee6e8bb pbrook
                }
7586 9ee6e8bb pbrook
                if (insn & (1 << 21)) {
7587 9ee6e8bb pbrook
                    /* Base register writeback.  */
7588 9ee6e8bb pbrook
                    if (insn & (1 << 24)) {
7589 b0109805 pbrook
                        tcg_gen_addi_i32(addr, addr, -offset);
7590 9ee6e8bb pbrook
                    }
7591 9ee6e8bb pbrook
                    /* Fault if writeback register is in register list.  */
7592 9ee6e8bb pbrook
                    if (insn & (1 << rn))
7593 9ee6e8bb pbrook
                        goto illegal_op;
7594 b0109805 pbrook
                    store_reg(s, rn, addr);
7595 b0109805 pbrook
                } else {
7596 b0109805 pbrook
                    dead_tmp(addr);
7597 9ee6e8bb pbrook
                }
7598 9ee6e8bb pbrook
            }
7599 9ee6e8bb pbrook
        }
7600 9ee6e8bb pbrook
        break;
7601 9ee6e8bb pbrook
    case 5: /* Data processing register constant shift.  */
7602 3174f8e9 Filip Navara
        if (rn == 15) {
7603 3174f8e9 Filip Navara
            tmp = new_tmp();
7604 3174f8e9 Filip Navara
            tcg_gen_movi_i32(tmp, 0);
7605 3174f8e9 Filip Navara
        } else {
7606 3174f8e9 Filip Navara
            tmp = load_reg(s, rn);
7607 3174f8e9 Filip Navara
        }
7608 3174f8e9 Filip Navara
        tmp2 = load_reg(s, rm);
7609 9ee6e8bb pbrook
        op = (insn >> 21) & 0xf;
7610 9ee6e8bb pbrook
        shiftop = (insn >> 4) & 3;
7611 9ee6e8bb pbrook
        shift = ((insn >> 6) & 3) | ((insn >> 10) & 0x1c);
7612 9ee6e8bb pbrook
        conds = (insn & (1 << 20)) != 0;
7613 9ee6e8bb pbrook
        logic_cc = (conds && thumb2_logic_op(op));
7614 3174f8e9 Filip Navara
        gen_arm_shift_im(tmp2, shiftop, shift, logic_cc);
7615 3174f8e9 Filip Navara
        if (gen_thumb2_data_op(s, op, conds, 0, tmp, tmp2))
7616 9ee6e8bb pbrook
            goto illegal_op;
7617 3174f8e9 Filip Navara
        dead_tmp(tmp2);
7618 3174f8e9 Filip Navara
        if (rd != 15) {
7619 3174f8e9 Filip Navara
            store_reg(s, rd, tmp);
7620 3174f8e9 Filip Navara
        } else {
7621 3174f8e9 Filip Navara
            dead_tmp(tmp);
7622 3174f8e9 Filip Navara
        }
7623 9ee6e8bb pbrook
        break;
7624 9ee6e8bb pbrook
    case 13: /* Misc data processing.  */
7625 9ee6e8bb pbrook
        op = ((insn >> 22) & 6) | ((insn >> 7) & 1);
7626 9ee6e8bb pbrook
        if (op < 4 && (insn & 0xf000) != 0xf000)
7627 9ee6e8bb pbrook
            goto illegal_op;
7628 9ee6e8bb pbrook
        switch (op) {
7629 9ee6e8bb pbrook
        case 0: /* Register controlled shift.  */
7630 8984bd2e pbrook
            tmp = load_reg(s, rn);
7631 8984bd2e pbrook
            tmp2 = load_reg(s, rm);
7632 9ee6e8bb pbrook
            if ((insn & 0x70) != 0)
7633 9ee6e8bb pbrook
                goto illegal_op;
7634 9ee6e8bb pbrook
            op = (insn >> 21) & 3;
7635 8984bd2e pbrook
            logic_cc = (insn & (1 << 20)) != 0;
7636 8984bd2e pbrook
            gen_arm_shift_reg(tmp, op, tmp2, logic_cc);
7637 8984bd2e pbrook
            if (logic_cc)
7638 8984bd2e pbrook
                gen_logic_CC(tmp);
7639 21aeb343 Juha Riihimรคki
            store_reg_bx(env, s, rd, tmp);
7640 9ee6e8bb pbrook
            break;
7641 9ee6e8bb pbrook
        case 1: /* Sign/zero extend.  */
7642 5e3f878a pbrook
            tmp = load_reg(s, rm);
7643 9ee6e8bb pbrook
            shift = (insn >> 4) & 3;
7644 9ee6e8bb pbrook
            /* ??? In many cases it's not neccessary to do a
7645 9ee6e8bb pbrook
               rotate, a shift is sufficient.  */
7646 9ee6e8bb pbrook
            if (shift != 0)
7647 f669df27 Aurelien Jarno
                tcg_gen_rotri_i32(tmp, tmp, shift * 8);
7648 9ee6e8bb pbrook
            op = (insn >> 20) & 7;
7649 9ee6e8bb pbrook
            switch (op) {
7650 5e3f878a pbrook
            case 0: gen_sxth(tmp);   break;
7651 5e3f878a pbrook
            case 1: gen_uxth(tmp);   break;
7652 5e3f878a pbrook
            case 2: gen_sxtb16(tmp); break;
7653 5e3f878a pbrook
            case 3: gen_uxtb16(tmp); break;
7654 5e3f878a pbrook
            case 4: gen_sxtb(tmp);   break;
7655 5e3f878a pbrook
            case 5: gen_uxtb(tmp);   break;
7656 9ee6e8bb pbrook
            default: goto illegal_op;
7657 9ee6e8bb pbrook
            }
7658 9ee6e8bb pbrook
            if (rn != 15) {
7659 5e3f878a pbrook
                tmp2 = load_reg(s, rn);
7660 9ee6e8bb pbrook
                if ((op >> 1) == 1) {
7661 5e3f878a pbrook
                    gen_add16(tmp, tmp2);
7662 9ee6e8bb pbrook
                } else {
7663 5e3f878a pbrook
                    tcg_gen_add_i32(tmp, tmp, tmp2);
7664 5e3f878a pbrook
                    dead_tmp(tmp2);
7665 9ee6e8bb pbrook
                }
7666 9ee6e8bb pbrook
            }
7667 5e3f878a pbrook
            store_reg(s, rd, tmp);
7668 9ee6e8bb pbrook
            break;
7669 9ee6e8bb pbrook
        case 2: /* SIMD add/subtract.  */
7670 9ee6e8bb pbrook
            op = (insn >> 20) & 7;
7671 9ee6e8bb pbrook
            shift = (insn >> 4) & 7;
7672 9ee6e8bb pbrook
            if ((op & 3) == 3 || (shift & 3) == 3)
7673 9ee6e8bb pbrook
                goto illegal_op;
7674 6ddbc6e4 pbrook
            tmp = load_reg(s, rn);
7675 6ddbc6e4 pbrook
            tmp2 = load_reg(s, rm);
7676 6ddbc6e4 pbrook
            gen_thumb2_parallel_addsub(op, shift, tmp, tmp2);
7677 6ddbc6e4 pbrook
            dead_tmp(tmp2);
7678 6ddbc6e4 pbrook
            store_reg(s, rd, tmp);
7679 9ee6e8bb pbrook
            break;
7680 9ee6e8bb pbrook
        case 3: /* Other data processing.  */
7681 9ee6e8bb pbrook
            op = ((insn >> 17) & 0x38) | ((insn >> 4) & 7);
7682 9ee6e8bb pbrook
            if (op < 4) {
7683 9ee6e8bb pbrook
                /* Saturating add/subtract.  */
7684 d9ba4830 pbrook
                tmp = load_reg(s, rn);
7685 d9ba4830 pbrook
                tmp2 = load_reg(s, rm);
7686 9ee6e8bb pbrook
                if (op & 2)
7687 d9ba4830 pbrook
                    gen_helper_double_saturate(tmp, tmp);
7688 9ee6e8bb pbrook
                if (op & 1)
7689 d9ba4830 pbrook
                    gen_helper_sub_saturate(tmp, tmp2, tmp);
7690 9ee6e8bb pbrook
                else
7691 d9ba4830 pbrook
                    gen_helper_add_saturate(tmp, tmp, tmp2);
7692 d9ba4830 pbrook
                dead_tmp(tmp2);
7693 9ee6e8bb pbrook
            } else {
7694 d9ba4830 pbrook
                tmp = load_reg(s, rn);
7695 9ee6e8bb pbrook
                switch (op) {
7696 9ee6e8bb pbrook
                case 0x0a: /* rbit */
7697 d9ba4830 pbrook
                    gen_helper_rbit(tmp, tmp);
7698 9ee6e8bb pbrook
                    break;
7699 9ee6e8bb pbrook
                case 0x08: /* rev */
7700 66896cb8 aurel32
                    tcg_gen_bswap32_i32(tmp, tmp);
7701 9ee6e8bb pbrook
                    break;
7702 9ee6e8bb pbrook
                case 0x09: /* rev16 */
7703 d9ba4830 pbrook
                    gen_rev16(tmp);
7704 9ee6e8bb pbrook
                    break;
7705 9ee6e8bb pbrook
                case 0x0b: /* revsh */
7706 d9ba4830 pbrook
                    gen_revsh(tmp);
7707 9ee6e8bb pbrook
                    break;
7708 9ee6e8bb pbrook
                case 0x10: /* sel */
7709 d9ba4830 pbrook
                    tmp2 = load_reg(s, rm);
7710 6ddbc6e4 pbrook
                    tmp3 = new_tmp();
7711 6ddbc6e4 pbrook
                    tcg_gen_ld_i32(tmp3, cpu_env, offsetof(CPUState, GE));
7712 d9ba4830 pbrook
                    gen_helper_sel_flags(tmp, tmp3, tmp, tmp2);
7713 6ddbc6e4 pbrook
                    dead_tmp(tmp3);
7714 d9ba4830 pbrook
                    dead_tmp(tmp2);
7715 9ee6e8bb pbrook
                    break;
7716 9ee6e8bb pbrook
                case 0x18: /* clz */
7717 d9ba4830 pbrook
                    gen_helper_clz(tmp, tmp);
7718 9ee6e8bb pbrook
                    break;
7719 9ee6e8bb pbrook
                default:
7720 9ee6e8bb pbrook
                    goto illegal_op;
7721 9ee6e8bb pbrook
                }
7722 9ee6e8bb pbrook
            }
7723 d9ba4830 pbrook
            store_reg(s, rd, tmp);
7724 9ee6e8bb pbrook
            break;
7725 9ee6e8bb pbrook
        case 4: case 5: /* 32-bit multiply.  Sum of absolute differences.  */
7726 9ee6e8bb pbrook
            op = (insn >> 4) & 0xf;
7727 d9ba4830 pbrook
            tmp = load_reg(s, rn);
7728 d9ba4830 pbrook
            tmp2 = load_reg(s, rm);
7729 9ee6e8bb pbrook
            switch ((insn >> 20) & 7) {
7730 9ee6e8bb pbrook
            case 0: /* 32 x 32 -> 32 */
7731 d9ba4830 pbrook
                tcg_gen_mul_i32(tmp, tmp, tmp2);
7732 d9ba4830 pbrook
                dead_tmp(tmp2);
7733 9ee6e8bb pbrook
                if (rs != 15) {
7734 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7735 9ee6e8bb pbrook
                    if (op)
7736 d9ba4830 pbrook
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
7737 9ee6e8bb pbrook
                    else
7738 d9ba4830 pbrook
                        tcg_gen_add_i32(tmp, tmp, tmp2);
7739 d9ba4830 pbrook
                    dead_tmp(tmp2);
7740 9ee6e8bb pbrook
                }
7741 9ee6e8bb pbrook
                break;
7742 9ee6e8bb pbrook
            case 1: /* 16 x 16 -> 32 */
7743 d9ba4830 pbrook
                gen_mulxy(tmp, tmp2, op & 2, op & 1);
7744 d9ba4830 pbrook
                dead_tmp(tmp2);
7745 9ee6e8bb pbrook
                if (rs != 15) {
7746 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7747 d9ba4830 pbrook
                    gen_helper_add_setq(tmp, tmp, tmp2);
7748 d9ba4830 pbrook
                    dead_tmp(tmp2);
7749 9ee6e8bb pbrook
                }
7750 9ee6e8bb pbrook
                break;
7751 9ee6e8bb pbrook
            case 2: /* Dual multiply add.  */
7752 9ee6e8bb pbrook
            case 4: /* Dual multiply subtract.  */
7753 9ee6e8bb pbrook
                if (op)
7754 d9ba4830 pbrook
                    gen_swap_half(tmp2);
7755 d9ba4830 pbrook
                gen_smul_dual(tmp, tmp2);
7756 9ee6e8bb pbrook
                /* This addition cannot overflow.  */
7757 9ee6e8bb pbrook
                if (insn & (1 << 22)) {
7758 d9ba4830 pbrook
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
7759 9ee6e8bb pbrook
                } else {
7760 d9ba4830 pbrook
                    tcg_gen_add_i32(tmp, tmp, tmp2);
7761 9ee6e8bb pbrook
                }
7762 d9ba4830 pbrook
                dead_tmp(tmp2);
7763 9ee6e8bb pbrook
                if (rs != 15)
7764 9ee6e8bb pbrook
                  {
7765 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7766 d9ba4830 pbrook
                    gen_helper_add_setq(tmp, tmp, tmp2);
7767 d9ba4830 pbrook
                    dead_tmp(tmp2);
7768 9ee6e8bb pbrook
                  }
7769 9ee6e8bb pbrook
                break;
7770 9ee6e8bb pbrook
            case 3: /* 32 * 16 -> 32msb */
7771 9ee6e8bb pbrook
                if (op)
7772 d9ba4830 pbrook
                    tcg_gen_sari_i32(tmp2, tmp2, 16);
7773 9ee6e8bb pbrook
                else
7774 d9ba4830 pbrook
                    gen_sxth(tmp2);
7775 a7812ae4 pbrook
                tmp64 = gen_muls_i64_i32(tmp, tmp2);
7776 a7812ae4 pbrook
                tcg_gen_shri_i64(tmp64, tmp64, 16);
7777 5e3f878a pbrook
                tmp = new_tmp();
7778 a7812ae4 pbrook
                tcg_gen_trunc_i64_i32(tmp, tmp64);
7779 b75263d6 Juha Riihimรคki
                tcg_temp_free_i64(tmp64);
7780 9ee6e8bb pbrook
                if (rs != 15)
7781 9ee6e8bb pbrook
                  {
7782 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7783 d9ba4830 pbrook
                    gen_helper_add_setq(tmp, tmp, tmp2);
7784 d9ba4830 pbrook
                    dead_tmp(tmp2);
7785 9ee6e8bb pbrook
                  }
7786 9ee6e8bb pbrook
                break;
7787 9ee6e8bb pbrook
            case 5: case 6: /* 32 * 32 -> 32msb */
7788 d9ba4830 pbrook
                gen_imull(tmp, tmp2);
7789 d9ba4830 pbrook
                if (insn & (1 << 5)) {
7790 d9ba4830 pbrook
                    gen_roundqd(tmp, tmp2);
7791 d9ba4830 pbrook
                    dead_tmp(tmp2);
7792 d9ba4830 pbrook
                } else {
7793 d9ba4830 pbrook
                    dead_tmp(tmp);
7794 d9ba4830 pbrook
                    tmp = tmp2;
7795 d9ba4830 pbrook
                }
7796 9ee6e8bb pbrook
                if (rs != 15) {
7797 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7798 9ee6e8bb pbrook
                    if (insn & (1 << 21)) {
7799 d9ba4830 pbrook
                        tcg_gen_add_i32(tmp, tmp, tmp2);
7800 99c475ab bellard
                    } else {
7801 d9ba4830 pbrook
                        tcg_gen_sub_i32(tmp, tmp2, tmp);
7802 99c475ab bellard
                    }
7803 d9ba4830 pbrook
                    dead_tmp(tmp2);
7804 2c0262af bellard
                }
7805 9ee6e8bb pbrook
                break;
7806 9ee6e8bb pbrook
            case 7: /* Unsigned sum of absolute differences.  */
7807 d9ba4830 pbrook
                gen_helper_usad8(tmp, tmp, tmp2);
7808 d9ba4830 pbrook
                dead_tmp(tmp2);
7809 9ee6e8bb pbrook
                if (rs != 15) {
7810 d9ba4830 pbrook
                    tmp2 = load_reg(s, rs);
7811 d9ba4830 pbrook
                    tcg_gen_add_i32(tmp, tmp, tmp2);
7812 d9ba4830 pbrook
                    dead_tmp(tmp2);
7813 5fd46862 pbrook
                }
7814 9ee6e8bb pbrook
                break;
7815 2c0262af bellard
            }
7816 d9ba4830 pbrook
            store_reg(s, rd, tmp);
7817 2c0262af bellard
            break;
7818 9ee6e8bb pbrook
        case 6: case 7: /* 64-bit multiply, Divide.  */
7819 9ee6e8bb pbrook
            op = ((insn >> 4) & 0xf) | ((insn >> 16) & 0x70);
7820 5e3f878a pbrook
            tmp = load_reg(s, rn);
7821 5e3f878a pbrook
            tmp2 = load_reg(s, rm);
7822 9ee6e8bb pbrook
            if ((op & 0x50) == 0x10) {
7823 9ee6e8bb pbrook
                /* sdiv, udiv */
7824 9ee6e8bb pbrook
                if (!arm_feature(env, ARM_FEATURE_DIV))
7825 9ee6e8bb pbrook
                    goto illegal_op;
7826 9ee6e8bb pbrook
                if (op & 0x20)
7827 5e3f878a pbrook
                    gen_helper_udiv(tmp, tmp, tmp2);
7828 2c0262af bellard
                else
7829 5e3f878a pbrook
                    gen_helper_sdiv(tmp, tmp, tmp2);
7830 5e3f878a pbrook
                dead_tmp(tmp2);
7831 5e3f878a pbrook
                store_reg(s, rd, tmp);
7832 9ee6e8bb pbrook
            } else if ((op & 0xe) == 0xc) {
7833 9ee6e8bb pbrook
                /* Dual multiply accumulate long.  */
7834 9ee6e8bb pbrook
                if (op & 1)
7835 5e3f878a pbrook
                    gen_swap_half(tmp2);
7836 5e3f878a pbrook
                gen_smul_dual(tmp, tmp2);
7837 9ee6e8bb pbrook
                if (op & 0x10) {
7838 5e3f878a pbrook
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
7839 b5ff1b31 bellard
                } else {
7840 5e3f878a pbrook
                    tcg_gen_add_i32(tmp, tmp, tmp2);
7841 b5ff1b31 bellard
                }
7842 5e3f878a pbrook
                dead_tmp(tmp2);
7843 a7812ae4 pbrook
                /* BUGFIX */
7844 a7812ae4 pbrook
                tmp64 = tcg_temp_new_i64();
7845 a7812ae4 pbrook
                tcg_gen_ext_i32_i64(tmp64, tmp);
7846 a7812ae4 pbrook
                dead_tmp(tmp);
7847 a7812ae4 pbrook
                gen_addq(s, tmp64, rs, rd);
7848 a7812ae4 pbrook
                gen_storeq_reg(s, rs, rd, tmp64);
7849 b75263d6 Juha Riihimรคki
                tcg_temp_free_i64(tmp64);
7850 2c0262af bellard
            } else {
7851 9ee6e8bb pbrook
                if (op & 0x20) {
7852 9ee6e8bb pbrook
                    /* Unsigned 64-bit multiply  */
7853 a7812ae4 pbrook
                    tmp64 = gen_mulu_i64_i32(tmp, tmp2);
7854 b5ff1b31 bellard
                } else {
7855 9ee6e8bb pbrook
                    if (op & 8) {
7856 9ee6e8bb pbrook
                        /* smlalxy */
7857 5e3f878a pbrook
                        gen_mulxy(tmp, tmp2, op & 2, op & 1);
7858 5e3f878a pbrook
                        dead_tmp(tmp2);
7859 a7812ae4 pbrook
                        tmp64 = tcg_temp_new_i64();
7860 a7812ae4 pbrook
                        tcg_gen_ext_i32_i64(tmp64, tmp);
7861 5e3f878a pbrook
                        dead_tmp(tmp);
7862 9ee6e8bb pbrook
                    } else {
7863 9ee6e8bb pbrook
                        /* Signed 64-bit multiply  */
7864 a7812ae4 pbrook
                        tmp64 = gen_muls_i64_i32(tmp, tmp2);
7865 9ee6e8bb pbrook
                    }
7866 b5ff1b31 bellard
                }
7867 9ee6e8bb pbrook
                if (op & 4) {
7868 9ee6e8bb pbrook
                    /* umaal */
7869 a7812ae4 pbrook
                    gen_addq_lo(s, tmp64, rs);
7870 a7812ae4 pbrook
                    gen_addq_lo(s, tmp64, rd);
7871 9ee6e8bb pbrook
                } else if (op & 0x40) {
7872 9ee6e8bb pbrook
                    /* 64-bit accumulate.  */
7873 a7812ae4 pbrook
                    gen_addq(s, tmp64, rs, rd);
7874 9ee6e8bb pbrook
                }
7875 a7812ae4 pbrook
                gen_storeq_reg(s, rs, rd, tmp64);
7876 b75263d6 Juha Riihimรคki
                tcg_temp_free_i64(tmp64);
7877 5fd46862 pbrook
            }
7878 2c0262af bellard
            break;
7879 9ee6e8bb pbrook
        }
7880 9ee6e8bb pbrook
        break;
7881 9ee6e8bb pbrook
    case 6: case 7: case 14: case 15:
7882 9ee6e8bb pbrook
        /* Coprocessor.  */
7883 9ee6e8bb pbrook
        if (((insn >> 24) & 3) == 3) {
7884 9ee6e8bb pbrook
            /* Translate into the equivalent ARM encoding.  */
7885 9ee6e8bb pbrook
            insn = (insn & 0xe2ffffff) | ((insn & (1 << 28)) >> 4);
7886 9ee6e8bb pbrook
            if (disas_neon_data_insn(env, s, insn))
7887 9ee6e8bb pbrook
                goto illegal_op;
7888 9ee6e8bb pbrook
        } else {
7889 9ee6e8bb pbrook
            if (insn & (1 << 28))
7890 9ee6e8bb pbrook
                goto illegal_op;
7891 9ee6e8bb pbrook
            if (disas_coproc_insn (env, s, insn))
7892 9ee6e8bb pbrook
                goto illegal_op;
7893 9ee6e8bb pbrook
        }
7894 9ee6e8bb pbrook
        break;
7895 9ee6e8bb pbrook
    case 8: case 9: case 10: case 11:
7896 9ee6e8bb pbrook
        if (insn & (1 << 15)) {
7897 9ee6e8bb pbrook
            /* Branches, misc control.  */
7898 9ee6e8bb pbrook
            if (insn & 0x5000) {
7899 9ee6e8bb pbrook
                /* Unconditional branch.  */
7900 9ee6e8bb pbrook
                /* signextend(hw1[10:0]) -> offset[:12].  */
7901 9ee6e8bb pbrook
                offset = ((int32_t)insn << 5) >> 9 & ~(int32_t)0xfff;
7902 9ee6e8bb pbrook
                /* hw1[10:0] -> offset[11:1].  */
7903 9ee6e8bb pbrook
                offset |= (insn & 0x7ff) << 1;
7904 9ee6e8bb pbrook
                /* (~hw2[13, 11] ^ offset[24]) -> offset[23,22]
7905 9ee6e8bb pbrook
                   offset[24:22] already have the same value because of the
7906 9ee6e8bb pbrook
                   sign extension above.  */
7907 9ee6e8bb pbrook
                offset ^= ((~insn) & (1 << 13)) << 10;
7908 9ee6e8bb pbrook
                offset ^= ((~insn) & (1 << 11)) << 11;
7909 9ee6e8bb pbrook
7910 9ee6e8bb pbrook
                if (insn & (1 << 14)) {
7911 9ee6e8bb pbrook
                    /* Branch and link.  */
7912 3174f8e9 Filip Navara
                    tcg_gen_movi_i32(cpu_R[14], s->pc | 1);
7913 b5ff1b31 bellard
                }
7914 3b46e624 ths
7915 b0109805 pbrook
                offset += s->pc;
7916 9ee6e8bb pbrook
                if (insn & (1 << 12)) {
7917 9ee6e8bb pbrook
                    /* b/bl */
7918 b0109805 pbrook
                    gen_jmp(s, offset);
7919 9ee6e8bb pbrook
                } else {
7920 9ee6e8bb pbrook
                    /* blx */
7921 b0109805 pbrook
                    offset &= ~(uint32_t)2;
7922 b0109805 pbrook
                    gen_bx_im(s, offset);
7923 2c0262af bellard
                }
7924 9ee6e8bb pbrook
            } else if (((insn >> 23) & 7) == 7) {
7925 9ee6e8bb pbrook
                /* Misc control */
7926 9ee6e8bb pbrook
                if (insn & (1 << 13))
7927 9ee6e8bb pbrook
                    goto illegal_op;
7928 9ee6e8bb pbrook
7929 9ee6e8bb pbrook
                if (insn & (1 << 26)) {
7930 9ee6e8bb pbrook
                    /* Secure monitor call (v6Z) */
7931 9ee6e8bb pbrook
                    goto illegal_op; /* not implemented.  */
7932 2c0262af bellard
                } else {
7933 9ee6e8bb pbrook
                    op = (insn >> 20) & 7;
7934 9ee6e8bb pbrook
                    switch (op) {
7935 9ee6e8bb pbrook
                    case 0: /* msr cpsr.  */
7936 9ee6e8bb pbrook
                        if (IS_M(env)) {
7937 8984bd2e pbrook
                            tmp = load_reg(s, rn);
7938 8984bd2e pbrook
                            addr = tcg_const_i32(insn & 0xff);
7939 8984bd2e pbrook
                            gen_helper_v7m_msr(cpu_env, addr, tmp);
7940 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i32(addr);
7941 b75263d6 Juha Riihimรคki
                            dead_tmp(tmp);
7942 9ee6e8bb pbrook
                            gen_lookup_tb(s);
7943 9ee6e8bb pbrook
                            break;
7944 9ee6e8bb pbrook
                        }
7945 9ee6e8bb pbrook
                        /* fall through */
7946 9ee6e8bb pbrook
                    case 1: /* msr spsr.  */
7947 9ee6e8bb pbrook
                        if (IS_M(env))
7948 9ee6e8bb pbrook
                            goto illegal_op;
7949 2fbac54b Filip Navara
                        tmp = load_reg(s, rn);
7950 2fbac54b Filip Navara
                        if (gen_set_psr(s,
7951 9ee6e8bb pbrook
                              msr_mask(env, s, (insn >> 8) & 0xf, op == 1),
7952 2fbac54b Filip Navara
                              op == 1, tmp))
7953 9ee6e8bb pbrook
                            goto illegal_op;
7954 9ee6e8bb pbrook
                        break;
7955 9ee6e8bb pbrook
                    case 2: /* cps, nop-hint.  */
7956 9ee6e8bb pbrook
                        if (((insn >> 8) & 7) == 0) {
7957 9ee6e8bb pbrook
                            gen_nop_hint(s, insn & 0xff);
7958 9ee6e8bb pbrook
                        }
7959 9ee6e8bb pbrook
                        /* Implemented as NOP in user mode.  */
7960 9ee6e8bb pbrook
                        if (IS_USER(s))
7961 9ee6e8bb pbrook
                            break;
7962 9ee6e8bb pbrook
                        offset = 0;
7963 9ee6e8bb pbrook
                        imm = 0;
7964 9ee6e8bb pbrook
                        if (insn & (1 << 10)) {
7965 9ee6e8bb pbrook
                            if (insn & (1 << 7))
7966 9ee6e8bb pbrook
                                offset |= CPSR_A;
7967 9ee6e8bb pbrook
                            if (insn & (1 << 6))
7968 9ee6e8bb pbrook
                                offset |= CPSR_I;
7969 9ee6e8bb pbrook
                            if (insn & (1 << 5))
7970 9ee6e8bb pbrook
                                offset |= CPSR_F;
7971 9ee6e8bb pbrook
                            if (insn & (1 << 9))
7972 9ee6e8bb pbrook
                                imm = CPSR_A | CPSR_I | CPSR_F;
7973 9ee6e8bb pbrook
                        }
7974 9ee6e8bb pbrook
                        if (insn & (1 << 8)) {
7975 9ee6e8bb pbrook
                            offset |= 0x1f;
7976 9ee6e8bb pbrook
                            imm |= (insn & 0x1f);
7977 9ee6e8bb pbrook
                        }
7978 9ee6e8bb pbrook
                        if (offset) {
7979 2fbac54b Filip Navara
                            gen_set_psr_im(s, offset, 0, imm);
7980 9ee6e8bb pbrook
                        }
7981 9ee6e8bb pbrook
                        break;
7982 9ee6e8bb pbrook
                    case 3: /* Special control operations.  */
7983 426f5abc Paul Brook
                        ARCH(7);
7984 9ee6e8bb pbrook
                        op = (insn >> 4) & 0xf;
7985 9ee6e8bb pbrook
                        switch (op) {
7986 9ee6e8bb pbrook
                        case 2: /* clrex */
7987 426f5abc Paul Brook
                            gen_clrex(s);
7988 9ee6e8bb pbrook
                            break;
7989 9ee6e8bb pbrook
                        case 4: /* dsb */
7990 9ee6e8bb pbrook
                        case 5: /* dmb */
7991 9ee6e8bb pbrook
                        case 6: /* isb */
7992 9ee6e8bb pbrook
                            /* These execute as NOPs.  */
7993 9ee6e8bb pbrook
                            break;
7994 9ee6e8bb pbrook
                        default:
7995 9ee6e8bb pbrook
                            goto illegal_op;
7996 9ee6e8bb pbrook
                        }
7997 9ee6e8bb pbrook
                        break;
7998 9ee6e8bb pbrook
                    case 4: /* bxj */
7999 9ee6e8bb pbrook
                        /* Trivial implementation equivalent to bx.  */
8000 d9ba4830 pbrook
                        tmp = load_reg(s, rn);
8001 d9ba4830 pbrook
                        gen_bx(s, tmp);
8002 9ee6e8bb pbrook
                        break;
8003 9ee6e8bb pbrook
                    case 5: /* Exception return.  */
8004 b8b45b68 Rabin Vincent
                        if (IS_USER(s)) {
8005 b8b45b68 Rabin Vincent
                            goto illegal_op;
8006 b8b45b68 Rabin Vincent
                        }
8007 b8b45b68 Rabin Vincent
                        if (rn != 14 || rd != 15) {
8008 b8b45b68 Rabin Vincent
                            goto illegal_op;
8009 b8b45b68 Rabin Vincent
                        }
8010 b8b45b68 Rabin Vincent
                        tmp = load_reg(s, rn);
8011 b8b45b68 Rabin Vincent
                        tcg_gen_subi_i32(tmp, tmp, insn & 0xff);
8012 b8b45b68 Rabin Vincent
                        gen_exception_return(s, tmp);
8013 b8b45b68 Rabin Vincent
                        break;
8014 9ee6e8bb pbrook
                    case 6: /* mrs cpsr.  */
8015 8984bd2e pbrook
                        tmp = new_tmp();
8016 9ee6e8bb pbrook
                        if (IS_M(env)) {
8017 8984bd2e pbrook
                            addr = tcg_const_i32(insn & 0xff);
8018 8984bd2e pbrook
                            gen_helper_v7m_mrs(tmp, cpu_env, addr);
8019 b75263d6 Juha Riihimรคki
                            tcg_temp_free_i32(addr);
8020 9ee6e8bb pbrook
                        } else {
8021 8984bd2e pbrook
                            gen_helper_cpsr_read(tmp);
8022 9ee6e8bb pbrook
                        }
8023 8984bd2e pbrook
                        store_reg(s, rd, tmp);
8024 9ee6e8bb pbrook
                        break;
8025 9ee6e8bb pbrook
                    case 7: /* mrs spsr.  */
8026 9ee6e8bb pbrook
                        /* Not accessible in user mode.  */
8027 9ee6e8bb pbrook
                        if (IS_USER(s) || IS_M(env))
8028 9ee6e8bb pbrook
                            goto illegal_op;
8029 d9ba4830 pbrook
                        tmp = load_cpu_field(spsr);
8030 d9ba4830 pbrook
                        store_reg(s, rd, tmp);
8031 9ee6e8bb pbrook
                        break;
8032 2c0262af bellard
                    }
8033 2c0262af bellard
                }
8034 9ee6e8bb pbrook
            } else {
8035 9ee6e8bb pbrook
                /* Conditional branch.  */
8036 9ee6e8bb pbrook
                op = (insn >> 22) & 0xf;
8037 9ee6e8bb pbrook
                /* Generate a conditional jump to next instruction.  */
8038 9ee6e8bb pbrook
                s->condlabel = gen_new_label();
8039 d9ba4830 pbrook
                gen_test_cc(op ^ 1, s->condlabel);
8040 9ee6e8bb pbrook
                s->condjmp = 1;
8041 9ee6e8bb pbrook
8042 9ee6e8bb pbrook
                /* offset[11:1] = insn[10:0] */
8043 9ee6e8bb pbrook
                offset = (insn & 0x7ff) << 1;
8044 9ee6e8bb pbrook
                /* offset[17:12] = insn[21:16].  */
8045 9ee6e8bb pbrook
                offset |= (insn & 0x003f0000) >> 4;
8046 9ee6e8bb pbrook
                /* offset[31:20] = insn[26].  */
8047 9ee6e8bb pbrook
                offset |= ((int32_t)((insn << 5) & 0x80000000)) >> 11;
8048 9ee6e8bb pbrook
                /* offset[18] = insn[13].  */
8049 9ee6e8bb pbrook
                offset |= (insn & (1 << 13)) << 5;
8050 9ee6e8bb pbrook
                /* offset[19] = insn[11].  */
8051 9ee6e8bb pbrook
                offset |= (insn & (1 << 11)) << 8;
8052 9ee6e8bb pbrook
8053 9ee6e8bb pbrook
                /* jump to the offset */
8054 b0109805 pbrook
                gen_jmp(s, s->pc + offset);
8055 9ee6e8bb pbrook
            }
8056 9ee6e8bb pbrook
        } else {
8057 9ee6e8bb pbrook
            /* Data processing immediate.  */
8058 9ee6e8bb pbrook
            if (insn & (1 << 25)) {
8059 9ee6e8bb pbrook
                if (insn & (1 << 24)) {
8060 9ee6e8bb pbrook
                    if (insn & (1 << 20))
8061 9ee6e8bb pbrook
                        goto illegal_op;
8062 9ee6e8bb pbrook
                    /* Bitfield/Saturate.  */
8063 9ee6e8bb pbrook
                    op = (insn >> 21) & 7;
8064 9ee6e8bb pbrook
                    imm = insn & 0x1f;
8065 9ee6e8bb pbrook
                    shift = ((insn >> 6) & 3) | ((insn >> 10) & 0x1c);
8066 6ddbc6e4 pbrook
                    if (rn == 15) {
8067 6ddbc6e4 pbrook
                        tmp = new_tmp();
8068 6ddbc6e4 pbrook
                        tcg_gen_movi_i32(tmp, 0);
8069 6ddbc6e4 pbrook
                    } else {
8070 6ddbc6e4 pbrook
                        tmp = load_reg(s, rn);
8071 6ddbc6e4 pbrook
                    }
8072 9ee6e8bb pbrook
                    switch (op) {
8073 9ee6e8bb pbrook
                    case 2: /* Signed bitfield extract.  */
8074 9ee6e8bb pbrook
                        imm++;
8075 9ee6e8bb pbrook
                        if (shift + imm > 32)
8076 9ee6e8bb pbrook
                            goto illegal_op;
8077 9ee6e8bb pbrook
                        if (imm < 32)
8078 6ddbc6e4 pbrook
                            gen_sbfx(tmp, shift, imm);
8079 9ee6e8bb pbrook
                        break;
8080 9ee6e8bb pbrook
                    case 6: /* Unsigned bitfield extract.  */
8081 9ee6e8bb pbrook
                        imm++;
8082 9ee6e8bb pbrook
                        if (shift + imm > 32)
8083 9ee6e8bb pbrook
                            goto illegal_op;
8084 9ee6e8bb pbrook
                        if (imm < 32)
8085 6ddbc6e4 pbrook
                            gen_ubfx(tmp, shift, (1u << imm) - 1);
8086 9ee6e8bb pbrook
                        break;
8087 9ee6e8bb pbrook
                    case 3: /* Bitfield insert/clear.  */
8088 9ee6e8bb pbrook
                        if (imm < shift)
8089 9ee6e8bb pbrook
                            goto illegal_op;
8090 9ee6e8bb pbrook
                        imm = imm + 1 - shift;
8091 9ee6e8bb pbrook
                        if (imm != 32) {
8092 6ddbc6e4 pbrook
                            tmp2 = load_reg(s, rd);
8093 8f8e3aa4 pbrook
                            gen_bfi(tmp, tmp2, tmp, shift, (1u << imm) - 1);
8094 6ddbc6e4 pbrook
                            dead_tmp(tmp2);
8095 9ee6e8bb pbrook
                        }
8096 9ee6e8bb pbrook
                        break;
8097 9ee6e8bb pbrook
                    case 7:
8098 9ee6e8bb pbrook
                        goto illegal_op;
8099 9ee6e8bb pbrook
                    default: /* Saturate.  */
8100 9ee6e8bb pbrook
                        if (shift) {
8101 9ee6e8bb pbrook
                            if (op & 1)
8102 6ddbc6e4 pbrook
                                tcg_gen_sari_i32(tmp, tmp, shift);
8103 9ee6e8bb pbrook
                            else
8104 6ddbc6e4 pbrook
                                tcg_gen_shli_i32(tmp, tmp, shift);
8105 9ee6e8bb pbrook
                        }
8106 6ddbc6e4 pbrook
                        tmp2 = tcg_const_i32(imm);
8107 9ee6e8bb pbrook
                        if (op & 4) {
8108 9ee6e8bb pbrook
                            /* Unsigned.  */
8109 9ee6e8bb pbrook
                            if ((op & 1) && shift == 0)
8110 6ddbc6e4 pbrook
                                gen_helper_usat16(tmp, tmp, tmp2);
8111 9ee6e8bb pbrook
                            else
8112 6ddbc6e4 pbrook
                                gen_helper_usat(tmp, tmp, tmp2);
8113 2c0262af bellard
                        } else {
8114 9ee6e8bb pbrook
                            /* Signed.  */
8115 9ee6e8bb pbrook
                            if ((op & 1) && shift == 0)
8116 6ddbc6e4 pbrook
                                gen_helper_ssat16(tmp, tmp, tmp2);
8117 9ee6e8bb pbrook
                            else
8118 6ddbc6e4 pbrook
                                gen_helper_ssat(tmp, tmp, tmp2);
8119 2c0262af bellard
                        }
8120 b75263d6 Juha Riihimรคki
                        tcg_temp_free_i32(tmp2);
8121 9ee6e8bb pbrook
                        break;
8122 2c0262af bellard
                    }
8123 6ddbc6e4 pbrook
                    store_reg(s, rd, tmp);
8124 9ee6e8bb pbrook
                } else {
8125 9ee6e8bb pbrook
                    imm = ((insn & 0x04000000) >> 15)
8126 9ee6e8bb pbrook
                          | ((insn & 0x7000) >> 4) | (insn & 0xff);
8127 9ee6e8bb pbrook
                    if (insn & (1 << 22)) {
8128 9ee6e8bb pbrook
                        /* 16-bit immediate.  */
8129 9ee6e8bb pbrook
                        imm |= (insn >> 4) & 0xf000;
8130 9ee6e8bb pbrook
                        if (insn & (1 << 23)) {
8131 9ee6e8bb pbrook
                            /* movt */
8132 5e3f878a pbrook
                            tmp = load_reg(s, rd);
8133 86831435 pbrook
                            tcg_gen_ext16u_i32(tmp, tmp);
8134 5e3f878a pbrook
                            tcg_gen_ori_i32(tmp, tmp, imm << 16);
8135 2c0262af bellard
                        } else {
8136 9ee6e8bb pbrook
                            /* movw */
8137 5e3f878a pbrook
                            tmp = new_tmp();
8138 5e3f878a pbrook
                            tcg_gen_movi_i32(tmp, imm);
8139 2c0262af bellard
                        }
8140 2c0262af bellard
                    } else {
8141 9ee6e8bb pbrook
                        /* Add/sub 12-bit immediate.  */
8142 9ee6e8bb pbrook
                        if (rn == 15) {
8143 b0109805 pbrook
                            offset = s->pc & ~(uint32_t)3;
8144 9ee6e8bb pbrook
                            if (insn & (1 << 23))
8145 b0109805 pbrook
                                offset -= imm;
8146 9ee6e8bb pbrook
                            else
8147 b0109805 pbrook
                                offset += imm;
8148 5e3f878a pbrook
                            tmp = new_tmp();
8149 5e3f878a pbrook
                            tcg_gen_movi_i32(tmp, offset);
8150 2c0262af bellard
                        } else {
8151 5e3f878a pbrook
                            tmp = load_reg(s, rn);
8152 9ee6e8bb pbrook
                            if (insn & (1 << 23))
8153 5e3f878a pbrook
                                tcg_gen_subi_i32(tmp, tmp, imm);
8154 9ee6e8bb pbrook
                            else
8155 5e3f878a pbrook
                                tcg_gen_addi_i32(tmp, tmp, imm);
8156 2c0262af bellard
                        }
8157 9ee6e8bb pbrook
                    }
8158 5e3f878a pbrook
                    store_reg(s, rd, tmp);
8159 191abaa2 pbrook
                }
8160 9ee6e8bb pbrook
            } else {
8161 9ee6e8bb pbrook
                int shifter_out = 0;
8162 9ee6e8bb pbrook
                /* modified 12-bit immediate.  */
8163 9ee6e8bb pbrook
                shift = ((insn & 0x04000000) >> 23) | ((insn & 0x7000) >> 12);
8164 9ee6e8bb pbrook
                imm = (insn & 0xff);
8165 9ee6e8bb pbrook
                switch (shift) {
8166 9ee6e8bb pbrook
                case 0: /* XY */
8167 9ee6e8bb pbrook
                    /* Nothing to do.  */
8168 9ee6e8bb pbrook
                    break;
8169 9ee6e8bb pbrook
                case 1: /* 00XY00XY */
8170 9ee6e8bb pbrook
                    imm |= imm << 16;
8171 9ee6e8bb pbrook
                    break;
8172 9ee6e8bb pbrook
                case 2: /* XY00XY00 */
8173 9ee6e8bb pbrook
                    imm |= imm << 16;
8174 9ee6e8bb pbrook
                    imm <<= 8;
8175 9ee6e8bb pbrook
                    break;
8176 9ee6e8bb pbrook
                case 3: /* XYXYXYXY */
8177 9ee6e8bb pbrook
                    imm |= imm << 16;
8178 9ee6e8bb pbrook
                    imm |= imm << 8;
8179 9ee6e8bb pbrook
                    break;
8180 9ee6e8bb pbrook
                default: /* Rotated constant.  */
8181 9ee6e8bb pbrook
                    shift = (shift << 1) | (imm >> 7);
8182 9ee6e8bb pbrook
                    imm |= 0x80;
8183 9ee6e8bb pbrook
                    imm = imm << (32 - shift);
8184 9ee6e8bb pbrook
                    shifter_out = 1;
8185 9ee6e8bb pbrook
                    break;
8186 b5ff1b31 bellard
                }
8187 3174f8e9 Filip Navara
                tmp2 = new_tmp();
8188 3174f8e9 Filip Navara
                tcg_gen_movi_i32(tmp2, imm);
8189 9ee6e8bb pbrook
                rn = (insn >> 16) & 0xf;
8190 3174f8e9 Filip Navara
                if (rn == 15) {
8191 3174f8e9 Filip Navara
                    tmp = new_tmp();
8192 3174f8e9 Filip Navara
                    tcg_gen_movi_i32(tmp, 0);
8193 3174f8e9 Filip Navara
                } else {
8194 3174f8e9 Filip Navara
                    tmp = load_reg(s, rn);
8195 3174f8e9 Filip Navara
                }
8196 9ee6e8bb pbrook
                op = (insn >> 21) & 0xf;
8197 9ee6e8bb pbrook
                if (gen_thumb2_data_op(s, op, (insn & (1 << 20)) != 0,
8198 3174f8e9 Filip Navara
                                       shifter_out, tmp, tmp2))
8199 9ee6e8bb pbrook
                    goto illegal_op;
8200 3174f8e9 Filip Navara
                dead_tmp(tmp2);
8201 9ee6e8bb pbrook
                rd = (insn >> 8) & 0xf;
8202 9ee6e8bb pbrook
                if (rd != 15) {
8203 3174f8e9 Filip Navara
                    store_reg(s, rd, tmp);
8204 3174f8e9 Filip Navara
                } else {
8205 3174f8e9 Filip Navara
                    dead_tmp(tmp);
8206 2c0262af bellard
                }
8207 2c0262af bellard
            }
8208 9ee6e8bb pbrook
        }
8209 9ee6e8bb pbrook
        break;
8210 9ee6e8bb pbrook
    case 12: /* Load/store single data item.  */
8211 9ee6e8bb pbrook
        {
8212 9ee6e8bb pbrook
        int postinc = 0;
8213 9ee6e8bb pbrook
        int writeback = 0;
8214 b0109805 pbrook
        int user;
8215 9ee6e8bb pbrook
        if ((insn & 0x01100000) == 0x01000000) {
8216 9ee6e8bb pbrook
            if (disas_neon_ls_insn(env, s, insn))
8217 c1713132 balrog
                goto illegal_op;
8218 9ee6e8bb pbrook
            break;
8219 9ee6e8bb pbrook
        }
8220 b0109805 pbrook
        user = IS_USER(s);
8221 9ee6e8bb pbrook
        if (rn == 15) {
8222 b0109805 pbrook
            addr = new_tmp();
8223 9ee6e8bb pbrook
            /* PC relative.  */
8224 9ee6e8bb pbrook
            /* s->pc has already been incremented by 4.  */
8225 9ee6e8bb pbrook
            imm = s->pc & 0xfffffffc;
8226 9ee6e8bb pbrook
            if (insn & (1 << 23))
8227 9ee6e8bb pbrook
                imm += insn & 0xfff;
8228 9ee6e8bb pbrook
            else
8229 9ee6e8bb pbrook
                imm -= insn & 0xfff;
8230 b0109805 pbrook
            tcg_gen_movi_i32(addr, imm);
8231 9ee6e8bb pbrook
        } else {
8232 b0109805 pbrook
            addr = load_reg(s, rn);
8233 9ee6e8bb pbrook
            if (insn & (1 << 23)) {
8234 9ee6e8bb pbrook
                /* Positive offset.  */
8235 9ee6e8bb pbrook
                imm = insn & 0xfff;
8236 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, imm);
8237 9ee6e8bb pbrook
            } else {
8238 9ee6e8bb pbrook
                op = (insn >> 8) & 7;
8239 9ee6e8bb pbrook
                imm = insn & 0xff;
8240 9ee6e8bb pbrook
                switch (op) {
8241 9ee6e8bb pbrook
                case 0: case 8: /* Shifted Register.  */
8242 9ee6e8bb pbrook
                    shift = (insn >> 4) & 0xf;
8243 9ee6e8bb pbrook
                    if (shift > 3)
8244 18c9b560 balrog
                        goto illegal_op;
8245 b26eefb6 pbrook
                    tmp = load_reg(s, rm);
8246 9ee6e8bb pbrook
                    if (shift)
8247 b26eefb6 pbrook
                        tcg_gen_shli_i32(tmp, tmp, shift);
8248 b0109805 pbrook
                    tcg_gen_add_i32(addr, addr, tmp);
8249 b26eefb6 pbrook
                    dead_tmp(tmp);
8250 9ee6e8bb pbrook
                    break;
8251 9ee6e8bb pbrook
                case 4: /* Negative offset.  */
8252 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, -imm);
8253 9ee6e8bb pbrook
                    break;
8254 9ee6e8bb pbrook
                case 6: /* User privilege.  */
8255 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, imm);
8256 b0109805 pbrook
                    user = 1;
8257 9ee6e8bb pbrook
                    break;
8258 9ee6e8bb pbrook
                case 1: /* Post-decrement.  */
8259 9ee6e8bb pbrook
                    imm = -imm;
8260 9ee6e8bb pbrook
                    /* Fall through.  */
8261 9ee6e8bb pbrook
                case 3: /* Post-increment.  */
8262 9ee6e8bb pbrook
                    postinc = 1;
8263 9ee6e8bb pbrook
                    writeback = 1;
8264 9ee6e8bb pbrook
                    break;
8265 9ee6e8bb pbrook
                case 5: /* Pre-decrement.  */
8266 9ee6e8bb pbrook
                    imm = -imm;
8267 9ee6e8bb pbrook
                    /* Fall through.  */
8268 9ee6e8bb pbrook
                case 7: /* Pre-increment.  */
8269 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, imm);
8270 9ee6e8bb pbrook
                    writeback = 1;
8271 9ee6e8bb pbrook
                    break;
8272 9ee6e8bb pbrook
                default:
8273 b7bcbe95 bellard
                    goto illegal_op;
8274 9ee6e8bb pbrook
                }
8275 9ee6e8bb pbrook
            }
8276 9ee6e8bb pbrook
        }
8277 9ee6e8bb pbrook
        op = ((insn >> 21) & 3) | ((insn >> 22) & 4);
8278 9ee6e8bb pbrook
        if (insn & (1 << 20)) {
8279 9ee6e8bb pbrook
            /* Load.  */
8280 9ee6e8bb pbrook
            if (rs == 15 && op != 2) {
8281 9ee6e8bb pbrook
                if (op & 2)
8282 b5ff1b31 bellard
                    goto illegal_op;
8283 9ee6e8bb pbrook
                /* Memory hint.  Implemented as NOP.  */
8284 9ee6e8bb pbrook
            } else {
8285 9ee6e8bb pbrook
                switch (op) {
8286 b0109805 pbrook
                case 0: tmp = gen_ld8u(addr, user); break;
8287 b0109805 pbrook
                case 4: tmp = gen_ld8s(addr, user); break;
8288 b0109805 pbrook
                case 1: tmp = gen_ld16u(addr, user); break;
8289 b0109805 pbrook
                case 5: tmp = gen_ld16s(addr, user); break;
8290 b0109805 pbrook
                case 2: tmp = gen_ld32(addr, user); break;
8291 9ee6e8bb pbrook
                default: goto illegal_op;
8292 9ee6e8bb pbrook
                }
8293 9ee6e8bb pbrook
                if (rs == 15) {
8294 b0109805 pbrook
                    gen_bx(s, tmp);
8295 9ee6e8bb pbrook
                } else {
8296 b0109805 pbrook
                    store_reg(s, rs, tmp);
8297 9ee6e8bb pbrook
                }
8298 9ee6e8bb pbrook
            }
8299 9ee6e8bb pbrook
        } else {
8300 9ee6e8bb pbrook
            /* Store.  */
8301 9ee6e8bb pbrook
            if (rs == 15)
8302 b7bcbe95 bellard
                goto illegal_op;
8303 b0109805 pbrook
            tmp = load_reg(s, rs);
8304 9ee6e8bb pbrook
            switch (op) {
8305 b0109805 pbrook
            case 0: gen_st8(tmp, addr, user); break;
8306 b0109805 pbrook
            case 1: gen_st16(tmp, addr, user); break;
8307 b0109805 pbrook
            case 2: gen_st32(tmp, addr, user); break;
8308 9ee6e8bb pbrook
            default: goto illegal_op;
8309 b7bcbe95 bellard
            }
8310 2c0262af bellard
        }
8311 9ee6e8bb pbrook
        if (postinc)
8312 b0109805 pbrook
            tcg_gen_addi_i32(addr, addr, imm);
8313 b0109805 pbrook
        if (writeback) {
8314 b0109805 pbrook
            store_reg(s, rn, addr);
8315 b0109805 pbrook
        } else {
8316 b0109805 pbrook
            dead_tmp(addr);
8317 b0109805 pbrook
        }
8318 9ee6e8bb pbrook
        }
8319 9ee6e8bb pbrook
        break;
8320 9ee6e8bb pbrook
    default:
8321 9ee6e8bb pbrook
        goto illegal_op;
8322 2c0262af bellard
    }
8323 9ee6e8bb pbrook
    return 0;
8324 9ee6e8bb pbrook
illegal_op:
8325 9ee6e8bb pbrook
    return 1;
8326 2c0262af bellard
}
8327 2c0262af bellard
8328 9ee6e8bb pbrook
static void disas_thumb_insn(CPUState *env, DisasContext *s)
8329 99c475ab bellard
{
8330 99c475ab bellard
    uint32_t val, insn, op, rm, rn, rd, shift, cond;
8331 99c475ab bellard
    int32_t offset;
8332 99c475ab bellard
    int i;
8333 b26eefb6 pbrook
    TCGv tmp;
8334 d9ba4830 pbrook
    TCGv tmp2;
8335 b0109805 pbrook
    TCGv addr;
8336 99c475ab bellard
8337 9ee6e8bb pbrook
    if (s->condexec_mask) {
8338 9ee6e8bb pbrook
        cond = s->condexec_cond;
8339 9ee6e8bb pbrook
        s->condlabel = gen_new_label();
8340 d9ba4830 pbrook
        gen_test_cc(cond ^ 1, s->condlabel);
8341 9ee6e8bb pbrook
        s->condjmp = 1;
8342 9ee6e8bb pbrook
    }
8343 9ee6e8bb pbrook
8344 b5ff1b31 bellard
    insn = lduw_code(s->pc);
8345 99c475ab bellard
    s->pc += 2;
8346 b5ff1b31 bellard
8347 99c475ab bellard
    switch (insn >> 12) {
8348 99c475ab bellard
    case 0: case 1:
8349 396e467c Filip Navara
8350 99c475ab bellard
        rd = insn & 7;
8351 99c475ab bellard
        op = (insn >> 11) & 3;
8352 99c475ab bellard
        if (op == 3) {
8353 99c475ab bellard
            /* add/subtract */
8354 99c475ab bellard
            rn = (insn >> 3) & 7;
8355 396e467c Filip Navara
            tmp = load_reg(s, rn);
8356 99c475ab bellard
            if (insn & (1 << 10)) {
8357 99c475ab bellard
                /* immediate */
8358 396e467c Filip Navara
                tmp2 = new_tmp();
8359 396e467c Filip Navara
                tcg_gen_movi_i32(tmp2, (insn >> 6) & 7);
8360 99c475ab bellard
            } else {
8361 99c475ab bellard
                /* reg */
8362 99c475ab bellard
                rm = (insn >> 6) & 7;
8363 396e467c Filip Navara
                tmp2 = load_reg(s, rm);
8364 99c475ab bellard
            }
8365 9ee6e8bb pbrook
            if (insn & (1 << 9)) {
8366 9ee6e8bb pbrook
                if (s->condexec_mask)
8367 396e467c Filip Navara
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
8368 9ee6e8bb pbrook
                else
8369 396e467c Filip Navara
                    gen_helper_sub_cc(tmp, tmp, tmp2);
8370 9ee6e8bb pbrook
            } else {
8371 9ee6e8bb pbrook
                if (s->condexec_mask)
8372 396e467c Filip Navara
                    tcg_gen_add_i32(tmp, tmp, tmp2);
8373 9ee6e8bb pbrook
                else
8374 396e467c Filip Navara
                    gen_helper_add_cc(tmp, tmp, tmp2);
8375 9ee6e8bb pbrook
            }
8376 396e467c Filip Navara
            dead_tmp(tmp2);
8377 396e467c Filip Navara
            store_reg(s, rd, tmp);
8378 99c475ab bellard
        } else {
8379 99c475ab bellard
            /* shift immediate */
8380 99c475ab bellard
            rm = (insn >> 3) & 7;
8381 99c475ab bellard
            shift = (insn >> 6) & 0x1f;
8382 9a119ff6 pbrook
            tmp = load_reg(s, rm);
8383 9a119ff6 pbrook
            gen_arm_shift_im(tmp, op, shift, s->condexec_mask == 0);
8384 9a119ff6 pbrook
            if (!s->condexec_mask)
8385 9a119ff6 pbrook
                gen_logic_CC(tmp);
8386 9a119ff6 pbrook
            store_reg(s, rd, tmp);
8387 99c475ab bellard
        }
8388 99c475ab bellard
        break;
8389 99c475ab bellard
    case 2: case 3:
8390 99c475ab bellard
        /* arithmetic large immediate */
8391 99c475ab bellard
        op = (insn >> 11) & 3;
8392 99c475ab bellard
        rd = (insn >> 8) & 0x7;
8393 396e467c Filip Navara
        if (op == 0) { /* mov */
8394 396e467c Filip Navara
            tmp = new_tmp();
8395 396e467c Filip Navara
            tcg_gen_movi_i32(tmp, insn & 0xff);
8396 9ee6e8bb pbrook
            if (!s->condexec_mask)
8397 396e467c Filip Navara
                gen_logic_CC(tmp);
8398 396e467c Filip Navara
            store_reg(s, rd, tmp);
8399 396e467c Filip Navara
        } else {
8400 396e467c Filip Navara
            tmp = load_reg(s, rd);
8401 396e467c Filip Navara
            tmp2 = new_tmp();
8402 396e467c Filip Navara
            tcg_gen_movi_i32(tmp2, insn & 0xff);
8403 396e467c Filip Navara
            switch (op) {
8404 396e467c Filip Navara
            case 1: /* cmp */
8405 396e467c Filip Navara
                gen_helper_sub_cc(tmp, tmp, tmp2);
8406 396e467c Filip Navara
                dead_tmp(tmp);
8407 396e467c Filip Navara
                dead_tmp(tmp2);
8408 396e467c Filip Navara
                break;
8409 396e467c Filip Navara
            case 2: /* add */
8410 396e467c Filip Navara
                if (s->condexec_mask)
8411 396e467c Filip Navara
                    tcg_gen_add_i32(tmp, tmp, tmp2);
8412 396e467c Filip Navara
                else
8413 396e467c Filip Navara
                    gen_helper_add_cc(tmp, tmp, tmp2);
8414 396e467c Filip Navara
                dead_tmp(tmp2);
8415 396e467c Filip Navara
                store_reg(s, rd, tmp);
8416 396e467c Filip Navara
                break;
8417 396e467c Filip Navara
            case 3: /* sub */
8418 396e467c Filip Navara
                if (s->condexec_mask)
8419 396e467c Filip Navara
                    tcg_gen_sub_i32(tmp, tmp, tmp2);
8420 396e467c Filip Navara
                else
8421 396e467c Filip Navara
                    gen_helper_sub_cc(tmp, tmp, tmp2);
8422 396e467c Filip Navara
                dead_tmp(tmp2);
8423 396e467c Filip Navara
                store_reg(s, rd, tmp);
8424 396e467c Filip Navara
                break;
8425 396e467c Filip Navara
            }
8426 99c475ab bellard
        }
8427 99c475ab bellard
        break;
8428 99c475ab bellard
    case 4:
8429 99c475ab bellard
        if (insn & (1 << 11)) {
8430 99c475ab bellard
            rd = (insn >> 8) & 7;
8431 5899f386 bellard
            /* load pc-relative.  Bit 1 of PC is ignored.  */
8432 5899f386 bellard
            val = s->pc + 2 + ((insn & 0xff) * 4);
8433 5899f386 bellard
            val &= ~(uint32_t)2;
8434 b0109805 pbrook
            addr = new_tmp();
8435 b0109805 pbrook
            tcg_gen_movi_i32(addr, val);
8436 b0109805 pbrook
            tmp = gen_ld32(addr, IS_USER(s));
8437 b0109805 pbrook
            dead_tmp(addr);
8438 b0109805 pbrook
            store_reg(s, rd, tmp);
8439 99c475ab bellard
            break;
8440 99c475ab bellard
        }
8441 99c475ab bellard
        if (insn & (1 << 10)) {
8442 99c475ab bellard
            /* data processing extended or blx */
8443 99c475ab bellard
            rd = (insn & 7) | ((insn >> 4) & 8);
8444 99c475ab bellard
            rm = (insn >> 3) & 0xf;
8445 99c475ab bellard
            op = (insn >> 8) & 3;
8446 99c475ab bellard
            switch (op) {
8447 99c475ab bellard
            case 0: /* add */
8448 396e467c Filip Navara
                tmp = load_reg(s, rd);
8449 396e467c Filip Navara
                tmp2 = load_reg(s, rm);
8450 396e467c Filip Navara
                tcg_gen_add_i32(tmp, tmp, tmp2);
8451 396e467c Filip Navara
                dead_tmp(tmp2);
8452 396e467c Filip Navara
                store_reg(s, rd, tmp);
8453 99c475ab bellard
                break;
8454 99c475ab bellard
            case 1: /* cmp */
8455 396e467c Filip Navara
                tmp = load_reg(s, rd);
8456 396e467c Filip Navara
                tmp2 = load_reg(s, rm);
8457 396e467c Filip Navara
                gen_helper_sub_cc(tmp, tmp, tmp2);
8458 396e467c Filip Navara
                dead_tmp(tmp2);
8459 396e467c Filip Navara
                dead_tmp(tmp);
8460 99c475ab bellard
                break;
8461 99c475ab bellard
            case 2: /* mov/cpy */
8462 396e467c Filip Navara
                tmp = load_reg(s, rm);
8463 396e467c Filip Navara
                store_reg(s, rd, tmp);
8464 99c475ab bellard
                break;
8465 99c475ab bellard
            case 3:/* branch [and link] exchange thumb register */
8466 b0109805 pbrook
                tmp = load_reg(s, rm);
8467 99c475ab bellard
                if (insn & (1 << 7)) {
8468 99c475ab bellard
                    val = (uint32_t)s->pc | 1;
8469 b0109805 pbrook
                    tmp2 = new_tmp();
8470 b0109805 pbrook
                    tcg_gen_movi_i32(tmp2, val);
8471 b0109805 pbrook
                    store_reg(s, 14, tmp2);
8472 99c475ab bellard
                }
8473 d9ba4830 pbrook
                gen_bx(s, tmp);
8474 99c475ab bellard
                break;
8475 99c475ab bellard
            }
8476 99c475ab bellard
            break;
8477 99c475ab bellard
        }
8478 99c475ab bellard
8479 99c475ab bellard
        /* data processing register */
8480 99c475ab bellard
        rd = insn & 7;
8481 99c475ab bellard
        rm = (insn >> 3) & 7;
8482 99c475ab bellard
        op = (insn >> 6) & 0xf;
8483 99c475ab bellard
        if (op == 2 || op == 3 || op == 4 || op == 7) {
8484 99c475ab bellard
            /* the shift/rotate ops want the operands backwards */
8485 99c475ab bellard
            val = rm;
8486 99c475ab bellard
            rm = rd;
8487 99c475ab bellard
            rd = val;
8488 99c475ab bellard
            val = 1;
8489 99c475ab bellard
        } else {
8490 99c475ab bellard
            val = 0;
8491 99c475ab bellard
        }
8492 99c475ab bellard
8493 396e467c Filip Navara
        if (op == 9) { /* neg */
8494 396e467c Filip Navara
            tmp = new_tmp();
8495 396e467c Filip Navara
            tcg_gen_movi_i32(tmp, 0);
8496 396e467c Filip Navara
        } else if (op != 0xf) { /* mvn doesn't read its first operand */
8497 396e467c Filip Navara
            tmp = load_reg(s, rd);
8498 396e467c Filip Navara
        } else {
8499 396e467c Filip Navara
            TCGV_UNUSED(tmp);
8500 396e467c Filip Navara
        }
8501 99c475ab bellard
8502 396e467c Filip Navara
        tmp2 = load_reg(s, rm);
8503 5899f386 bellard
        switch (op) {
8504 99c475ab bellard
        case 0x0: /* and */
8505 396e467c Filip Navara
            tcg_gen_and_i32(tmp, tmp, tmp2);
8506 9ee6e8bb pbrook
            if (!s->condexec_mask)
8507 396e467c Filip Navara
                gen_logic_CC(tmp);
8508 99c475ab bellard
            break;
8509 99c475ab bellard
        case 0x1: /* eor */
8510 396e467c Filip Navara
            tcg_gen_xor_i32(tmp, tmp, tmp2);
8511 9ee6e8bb pbrook
            if (!s->condexec_mask)
8512 396e467c Filip Navara
                gen_logic_CC(tmp);
8513 99c475ab bellard
            break;
8514 99c475ab bellard
        case 0x2: /* lsl */
8515 9ee6e8bb pbrook
            if (s->condexec_mask) {
8516 396e467c Filip Navara
                gen_helper_shl(tmp2, tmp2, tmp);
8517 9ee6e8bb pbrook
            } else {
8518 396e467c Filip Navara
                gen_helper_shl_cc(tmp2, tmp2, tmp);
8519 396e467c Filip Navara
                gen_logic_CC(tmp2);
8520 9ee6e8bb pbrook
            }
8521 99c475ab bellard
            break;
8522 99c475ab bellard
        case 0x3: /* lsr */
8523 9ee6e8bb pbrook
            if (s->condexec_mask) {
8524 396e467c Filip Navara
                gen_helper_shr(tmp2, tmp2, tmp);
8525 9ee6e8bb pbrook
            } else {
8526 396e467c Filip Navara
                gen_helper_shr_cc(tmp2, tmp2, tmp);
8527 396e467c Filip Navara
                gen_logic_CC(tmp2);
8528 9ee6e8bb pbrook
            }
8529 99c475ab bellard
            break;
8530 99c475ab bellard
        case 0x4: /* asr */
8531 9ee6e8bb pbrook
            if (s->condexec_mask) {
8532 396e467c Filip Navara
                gen_helper_sar(tmp2, tmp2, tmp);
8533 9ee6e8bb pbrook
            } else {
8534 396e467c Filip Navara
                gen_helper_sar_cc(tmp2, tmp2, tmp);
8535 396e467c Filip Navara
                gen_logic_CC(tmp2);
8536 9ee6e8bb pbrook
            }
8537 99c475ab bellard
            break;
8538 99c475ab bellard
        case 0x5: /* adc */
8539 9ee6e8bb pbrook
            if (s->condexec_mask)
8540 396e467c Filip Navara
                gen_adc(tmp, tmp2);
8541 9ee6e8bb pbrook
            else
8542 396e467c Filip Navara
                gen_helper_adc_cc(tmp, tmp, tmp2);
8543 99c475ab bellard
            break;
8544 99c475ab bellard
        case 0x6: /* sbc */
8545 9ee6e8bb pbrook
            if (s->condexec_mask)
8546 396e467c Filip Navara
                gen_sub_carry(tmp, tmp, tmp2);
8547 9ee6e8bb pbrook
            else
8548 396e467c Filip Navara
                gen_helper_sbc_cc(tmp, tmp, tmp2);
8549 99c475ab bellard
            break;
8550 99c475ab bellard
        case 0x7: /* ror */
8551 9ee6e8bb pbrook
            if (s->condexec_mask) {
8552 f669df27 Aurelien Jarno
                tcg_gen_andi_i32(tmp, tmp, 0x1f);
8553 f669df27 Aurelien Jarno
                tcg_gen_rotr_i32(tmp2, tmp2, tmp);
8554 9ee6e8bb pbrook
            } else {
8555 396e467c Filip Navara
                gen_helper_ror_cc(tmp2, tmp2, tmp);
8556 396e467c Filip Navara
                gen_logic_CC(tmp2);
8557 9ee6e8bb pbrook
            }
8558 99c475ab bellard
            break;
8559 99c475ab bellard
        case 0x8: /* tst */
8560 396e467c Filip Navara
            tcg_gen_and_i32(tmp, tmp, tmp2);
8561 396e467c Filip Navara
            gen_logic_CC(tmp);
8562 99c475ab bellard
            rd = 16;
8563 5899f386 bellard
            break;
8564 99c475ab bellard
        case 0x9: /* neg */
8565 9ee6e8bb pbrook
            if (s->condexec_mask)
8566 396e467c Filip Navara
                tcg_gen_neg_i32(tmp, tmp2);
8567 9ee6e8bb pbrook
            else
8568 396e467c Filip Navara
                gen_helper_sub_cc(tmp, tmp, tmp2);
8569 99c475ab bellard
            break;
8570 99c475ab bellard
        case 0xa: /* cmp */
8571 396e467c Filip Navara
            gen_helper_sub_cc(tmp, tmp, tmp2);
8572 99c475ab bellard
            rd = 16;
8573 99c475ab bellard
            break;
8574 99c475ab bellard
        case 0xb: /* cmn */
8575 396e467c Filip Navara
            gen_helper_add_cc(tmp, tmp, tmp2);
8576 99c475ab bellard
            rd = 16;
8577 99c475ab bellard
            break;
8578 99c475ab bellard
        case 0xc: /* orr */
8579 396e467c Filip Navara
            tcg_gen_or_i32(tmp, tmp, tmp2);
8580 9ee6e8bb pbrook
            if (!s->condexec_mask)
8581 396e467c Filip Navara
                gen_logic_CC(tmp);
8582 99c475ab bellard
            break;
8583 99c475ab bellard
        case 0xd: /* mul */
8584 7b2919a0 Juha.Riihimaki@nokia.com
            tcg_gen_mul_i32(tmp, tmp, tmp2);
8585 9ee6e8bb pbrook
            if (!s->condexec_mask)
8586 396e467c Filip Navara
                gen_logic_CC(tmp);
8587 99c475ab bellard
            break;
8588 99c475ab bellard
        case 0xe: /* bic */
8589 f669df27 Aurelien Jarno
            tcg_gen_andc_i32(tmp, tmp, tmp2);
8590 9ee6e8bb pbrook
            if (!s->condexec_mask)
8591 396e467c Filip Navara
                gen_logic_CC(tmp);
8592 99c475ab bellard
            break;
8593 99c475ab bellard
        case 0xf: /* mvn */
8594 396e467c Filip Navara
            tcg_gen_not_i32(tmp2, tmp2);
8595 9ee6e8bb pbrook
            if (!s->condexec_mask)
8596 396e467c Filip Navara
                gen_logic_CC(tmp2);
8597 99c475ab bellard
            val = 1;
8598 5899f386 bellard
            rm = rd;
8599 99c475ab bellard
            break;
8600 99c475ab bellard
        }
8601 99c475ab bellard
        if (rd != 16) {
8602 396e467c Filip Navara
            if (val) {
8603 396e467c Filip Navara
                store_reg(s, rm, tmp2);
8604 396e467c Filip Navara
                if (op != 0xf)
8605 396e467c Filip Navara
                    dead_tmp(tmp);
8606 396e467c Filip Navara
            } else {
8607 396e467c Filip Navara
                store_reg(s, rd, tmp);
8608 396e467c Filip Navara
                dead_tmp(tmp2);
8609 396e467c Filip Navara
            }
8610 396e467c Filip Navara
        } else {
8611 396e467c Filip Navara
            dead_tmp(tmp);
8612 396e467c Filip Navara
            dead_tmp(tmp2);
8613 99c475ab bellard
        }
8614 99c475ab bellard
        break;
8615 99c475ab bellard
8616 99c475ab bellard
    case 5:
8617 99c475ab bellard
        /* load/store register offset.  */
8618 99c475ab bellard
        rd = insn & 7;
8619 99c475ab bellard
        rn = (insn >> 3) & 7;
8620 99c475ab bellard
        rm = (insn >> 6) & 7;
8621 99c475ab bellard
        op = (insn >> 9) & 7;
8622 b0109805 pbrook
        addr = load_reg(s, rn);
8623 b26eefb6 pbrook
        tmp = load_reg(s, rm);
8624 b0109805 pbrook
        tcg_gen_add_i32(addr, addr, tmp);
8625 b26eefb6 pbrook
        dead_tmp(tmp);
8626 99c475ab bellard
8627 99c475ab bellard
        if (op < 3) /* store */
8628 b0109805 pbrook
            tmp = load_reg(s, rd);
8629 99c475ab bellard
8630 99c475ab bellard
        switch (op) {
8631 99c475ab bellard
        case 0: /* str */
8632 b0109805 pbrook
            gen_st32(tmp, addr, IS_USER(s));
8633 99c475ab bellard
            break;
8634 99c475ab bellard
        case 1: /* strh */
8635 b0109805 pbrook
            gen_st16(tmp, addr, IS_USER(s));
8636 99c475ab bellard
            break;
8637 99c475ab bellard
        case 2: /* strb */
8638 b0109805 pbrook
            gen_st8(tmp, addr, IS_USER(s));
8639 99c475ab bellard
            break;
8640 99c475ab bellard
        case 3: /* ldrsb */
8641 b0109805 pbrook
            tmp = gen_ld8s(addr, IS_USER(s));
8642 99c475ab bellard
            break;
8643 99c475ab bellard
        case 4: /* ldr */
8644 b0109805 pbrook
            tmp = gen_ld32(addr, IS_USER(s));
8645 99c475ab bellard
            break;
8646 99c475ab bellard
        case 5: /* ldrh */
8647 b0109805 pbrook
            tmp = gen_ld16u(addr, IS_USER(s));
8648 99c475ab bellard
            break;
8649 99c475ab bellard
        case 6: /* ldrb */
8650 b0109805 pbrook
            tmp = gen_ld8u(addr, IS_USER(s));
8651 99c475ab bellard
            break;
8652 99c475ab bellard
        case 7: /* ldrsh */
8653 b0109805 pbrook
            tmp = gen_ld16s(addr, IS_USER(s));
8654 99c475ab bellard
            break;
8655 99c475ab bellard
        }
8656 99c475ab bellard
        if (op >= 3) /* load */
8657 b0109805 pbrook
            store_reg(s, rd, tmp);
8658 b0109805 pbrook
        dead_tmp(addr);
8659 99c475ab bellard
        break;
8660 99c475ab bellard
8661 99c475ab bellard
    case 6:
8662 99c475ab bellard
        /* load/store word immediate offset */
8663 99c475ab bellard
        rd = insn & 7;
8664 99c475ab bellard
        rn = (insn >> 3) & 7;
8665 b0109805 pbrook
        addr = load_reg(s, rn);
8666 99c475ab bellard
        val = (insn >> 4) & 0x7c;
8667 b0109805 pbrook
        tcg_gen_addi_i32(addr, addr, val);
8668 99c475ab bellard
8669 99c475ab bellard
        if (insn & (1 << 11)) {
8670 99c475ab bellard
            /* load */
8671 b0109805 pbrook
            tmp = gen_ld32(addr, IS_USER(s));
8672 b0109805 pbrook
            store_reg(s, rd, tmp);
8673 99c475ab bellard
        } else {
8674 99c475ab bellard
            /* store */
8675 b0109805 pbrook
            tmp = load_reg(s, rd);
8676 b0109805 pbrook
            gen_st32(tmp, addr, IS_USER(s));
8677 99c475ab bellard
        }
8678 b0109805 pbrook
        dead_tmp(addr);
8679 99c475ab bellard
        break;
8680 99c475ab bellard
8681 99c475ab bellard
    case 7:
8682 99c475ab bellard
        /* load/store byte immediate offset */
8683 99c475ab bellard
        rd = insn & 7;
8684 99c475ab bellard
        rn = (insn >> 3) & 7;
8685 b0109805 pbrook
        addr = load_reg(s, rn);
8686 99c475ab bellard
        val = (insn >> 6) & 0x1f;
8687 b0109805 pbrook
        tcg_gen_addi_i32(addr, addr, val);
8688 99c475ab bellard
8689 99c475ab bellard
        if (insn & (1 << 11)) {
8690 99c475ab bellard
            /* load */
8691 b0109805 pbrook
            tmp = gen_ld8u(addr, IS_USER(s));
8692 b0109805 pbrook
            store_reg(s, rd, tmp);
8693 99c475ab bellard
        } else {
8694 99c475ab bellard
            /* store */
8695 b0109805 pbrook
            tmp = load_reg(s, rd);
8696 b0109805 pbrook
            gen_st8(tmp, addr, IS_USER(s));
8697 99c475ab bellard
        }
8698 b0109805 pbrook
        dead_tmp(addr);
8699 99c475ab bellard
        break;
8700 99c475ab bellard
8701 99c475ab bellard
    case 8:
8702 99c475ab bellard
        /* load/store halfword immediate offset */
8703 99c475ab bellard
        rd = insn & 7;
8704 99c475ab bellard
        rn = (insn >> 3) & 7;
8705 b0109805 pbrook
        addr = load_reg(s, rn);
8706 99c475ab bellard
        val = (insn >> 5) & 0x3e;
8707 b0109805 pbrook
        tcg_gen_addi_i32(addr, addr, val);
8708 99c475ab bellard
8709 99c475ab bellard
        if (insn & (1 << 11)) {
8710 99c475ab bellard
            /* load */
8711 b0109805 pbrook
            tmp = gen_ld16u(addr, IS_USER(s));
8712 b0109805 pbrook
            store_reg(s, rd, tmp);
8713 99c475ab bellard
        } else {
8714 99c475ab bellard
            /* store */
8715 b0109805 pbrook
            tmp = load_reg(s, rd);
8716 b0109805 pbrook
            gen_st16(tmp, addr, IS_USER(s));
8717 99c475ab bellard
        }
8718 b0109805 pbrook
        dead_tmp(addr);
8719 99c475ab bellard
        break;
8720 99c475ab bellard
8721 99c475ab bellard
    case 9:
8722 99c475ab bellard
        /* load/store from stack */
8723 99c475ab bellard
        rd = (insn >> 8) & 7;
8724 b0109805 pbrook
        addr = load_reg(s, 13);
8725 99c475ab bellard
        val = (insn & 0xff) * 4;
8726 b0109805 pbrook
        tcg_gen_addi_i32(addr, addr, val);
8727 99c475ab bellard
8728 99c475ab bellard
        if (insn & (1 << 11)) {
8729 99c475ab bellard
            /* load */
8730 b0109805 pbrook
            tmp = gen_ld32(addr, IS_USER(s));
8731 b0109805 pbrook
            store_reg(s, rd, tmp);
8732 99c475ab bellard
        } else {
8733 99c475ab bellard
            /* store */
8734 b0109805 pbrook
            tmp = load_reg(s, rd);
8735 b0109805 pbrook
            gen_st32(tmp, addr, IS_USER(s));
8736 99c475ab bellard
        }
8737 b0109805 pbrook
        dead_tmp(addr);
8738 99c475ab bellard
        break;
8739 99c475ab bellard
8740 99c475ab bellard
    case 10:
8741 99c475ab bellard
        /* add to high reg */
8742 99c475ab bellard
        rd = (insn >> 8) & 7;
8743 5899f386 bellard
        if (insn & (1 << 11)) {
8744 5899f386 bellard
            /* SP */
8745 5e3f878a pbrook
            tmp = load_reg(s, 13);
8746 5899f386 bellard
        } else {
8747 5899f386 bellard
            /* PC. bit 1 is ignored.  */
8748 5e3f878a pbrook
            tmp = new_tmp();
8749 5e3f878a pbrook
            tcg_gen_movi_i32(tmp, (s->pc + 2) & ~(uint32_t)2);
8750 5899f386 bellard
        }
8751 99c475ab bellard
        val = (insn & 0xff) * 4;
8752 5e3f878a pbrook
        tcg_gen_addi_i32(tmp, tmp, val);
8753 5e3f878a pbrook
        store_reg(s, rd, tmp);
8754 99c475ab bellard
        break;
8755 99c475ab bellard
8756 99c475ab bellard
    case 11:
8757 99c475ab bellard
        /* misc */
8758 99c475ab bellard
        op = (insn >> 8) & 0xf;
8759 99c475ab bellard
        switch (op) {
8760 99c475ab bellard
        case 0:
8761 99c475ab bellard
            /* adjust stack pointer */
8762 b26eefb6 pbrook
            tmp = load_reg(s, 13);
8763 99c475ab bellard
            val = (insn & 0x7f) * 4;
8764 99c475ab bellard
            if (insn & (1 << 7))
8765 6a0d8a1d balrog
                val = -(int32_t)val;
8766 b26eefb6 pbrook
            tcg_gen_addi_i32(tmp, tmp, val);
8767 b26eefb6 pbrook
            store_reg(s, 13, tmp);
8768 99c475ab bellard
            break;
8769 99c475ab bellard
8770 9ee6e8bb pbrook
        case 2: /* sign/zero extend.  */
8771 9ee6e8bb pbrook
            ARCH(6);
8772 9ee6e8bb pbrook
            rd = insn & 7;
8773 9ee6e8bb pbrook
            rm = (insn >> 3) & 7;
8774 b0109805 pbrook
            tmp = load_reg(s, rm);
8775 9ee6e8bb pbrook
            switch ((insn >> 6) & 3) {
8776 b0109805 pbrook
            case 0: gen_sxth(tmp); break;
8777 b0109805 pbrook
            case 1: gen_sxtb(tmp); break;
8778 b0109805 pbrook
            case 2: gen_uxth(tmp); break;
8779 b0109805 pbrook
            case 3: gen_uxtb(tmp); break;
8780 9ee6e8bb pbrook
            }
8781 b0109805 pbrook
            store_reg(s, rd, tmp);
8782 9ee6e8bb pbrook
            break;
8783 99c475ab bellard
        case 4: case 5: case 0xc: case 0xd:
8784 99c475ab bellard
            /* push/pop */
8785 b0109805 pbrook
            addr = load_reg(s, 13);
8786 5899f386 bellard
            if (insn & (1 << 8))
8787 5899f386 bellard
                offset = 4;
8788 99c475ab bellard
            else
8789 5899f386 bellard
                offset = 0;
8790 5899f386 bellard
            for (i = 0; i < 8; i++) {
8791 5899f386 bellard
                if (insn & (1 << i))
8792 5899f386 bellard
                    offset += 4;
8793 5899f386 bellard
            }
8794 5899f386 bellard
            if ((insn & (1 << 11)) == 0) {
8795 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, -offset);
8796 5899f386 bellard
            }
8797 99c475ab bellard
            for (i = 0; i < 8; i++) {
8798 99c475ab bellard
                if (insn & (1 << i)) {
8799 99c475ab bellard
                    if (insn & (1 << 11)) {
8800 99c475ab bellard
                        /* pop */
8801 b0109805 pbrook
                        tmp = gen_ld32(addr, IS_USER(s));
8802 b0109805 pbrook
                        store_reg(s, i, tmp);
8803 99c475ab bellard
                    } else {
8804 99c475ab bellard
                        /* push */
8805 b0109805 pbrook
                        tmp = load_reg(s, i);
8806 b0109805 pbrook
                        gen_st32(tmp, addr, IS_USER(s));
8807 99c475ab bellard
                    }
8808 5899f386 bellard
                    /* advance to the next address.  */
8809 b0109805 pbrook
                    tcg_gen_addi_i32(addr, addr, 4);
8810 99c475ab bellard
                }
8811 99c475ab bellard
            }
8812 a50f5b91 pbrook
            TCGV_UNUSED(tmp);
8813 99c475ab bellard
            if (insn & (1 << 8)) {
8814 99c475ab bellard
                if (insn & (1 << 11)) {
8815 99c475ab bellard
                    /* pop pc */
8816 b0109805 pbrook
                    tmp = gen_ld32(addr, IS_USER(s));
8817 99c475ab bellard
                    /* don't set the pc until the rest of the instruction
8818 99c475ab bellard
                       has completed */
8819 99c475ab bellard
                } else {
8820 99c475ab bellard
                    /* push lr */
8821 b0109805 pbrook
                    tmp = load_reg(s, 14);
8822 b0109805 pbrook
                    gen_st32(tmp, addr, IS_USER(s));
8823 99c475ab bellard
                }
8824 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, 4);
8825 99c475ab bellard
            }
8826 5899f386 bellard
            if ((insn & (1 << 11)) == 0) {
8827 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, -offset);
8828 5899f386 bellard
            }
8829 99c475ab bellard
            /* write back the new stack pointer */
8830 b0109805 pbrook
            store_reg(s, 13, addr);
8831 99c475ab bellard
            /* set the new PC value */
8832 99c475ab bellard
            if ((insn & 0x0900) == 0x0900)
8833 b0109805 pbrook
                gen_bx(s, tmp);
8834 99c475ab bellard
            break;
8835 99c475ab bellard
8836 9ee6e8bb pbrook
        case 1: case 3: case 9: case 11: /* czb */
8837 9ee6e8bb pbrook
            rm = insn & 7;
8838 d9ba4830 pbrook
            tmp = load_reg(s, rm);
8839 9ee6e8bb pbrook
            s->condlabel = gen_new_label();
8840 9ee6e8bb pbrook
            s->condjmp = 1;
8841 9ee6e8bb pbrook
            if (insn & (1 << 11))
8842 cb63669a pbrook
                tcg_gen_brcondi_i32(TCG_COND_EQ, tmp, 0, s->condlabel);
8843 9ee6e8bb pbrook
            else
8844 cb63669a pbrook
                tcg_gen_brcondi_i32(TCG_COND_NE, tmp, 0, s->condlabel);
8845 d9ba4830 pbrook
            dead_tmp(tmp);
8846 9ee6e8bb pbrook
            offset = ((insn & 0xf8) >> 2) | (insn & 0x200) >> 3;
8847 9ee6e8bb pbrook
            val = (uint32_t)s->pc + 2;
8848 9ee6e8bb pbrook
            val += offset;
8849 9ee6e8bb pbrook
            gen_jmp(s, val);
8850 9ee6e8bb pbrook
            break;
8851 9ee6e8bb pbrook
8852 9ee6e8bb pbrook
        case 15: /* IT, nop-hint.  */
8853 9ee6e8bb pbrook
            if ((insn & 0xf) == 0) {
8854 9ee6e8bb pbrook
                gen_nop_hint(s, (insn >> 4) & 0xf);
8855 9ee6e8bb pbrook
                break;
8856 9ee6e8bb pbrook
            }
8857 9ee6e8bb pbrook
            /* If Then.  */
8858 9ee6e8bb pbrook
            s->condexec_cond = (insn >> 4) & 0xe;
8859 9ee6e8bb pbrook
            s->condexec_mask = insn & 0x1f;
8860 9ee6e8bb pbrook
            /* No actual code generated for this insn, just setup state.  */
8861 9ee6e8bb pbrook
            break;
8862 9ee6e8bb pbrook
8863 06c949e6 pbrook
        case 0xe: /* bkpt */
8864 9ee6e8bb pbrook
            gen_set_condexec(s);
8865 5e3f878a pbrook
            gen_set_pc_im(s->pc - 2);
8866 d9ba4830 pbrook
            gen_exception(EXCP_BKPT);
8867 06c949e6 pbrook
            s->is_jmp = DISAS_JUMP;
8868 06c949e6 pbrook
            break;
8869 06c949e6 pbrook
8870 9ee6e8bb pbrook
        case 0xa: /* rev */
8871 9ee6e8bb pbrook
            ARCH(6);
8872 9ee6e8bb pbrook
            rn = (insn >> 3) & 0x7;
8873 9ee6e8bb pbrook
            rd = insn & 0x7;
8874 b0109805 pbrook
            tmp = load_reg(s, rn);
8875 9ee6e8bb pbrook
            switch ((insn >> 6) & 3) {
8876 66896cb8 aurel32
            case 0: tcg_gen_bswap32_i32(tmp, tmp); break;
8877 b0109805 pbrook
            case 1: gen_rev16(tmp); break;
8878 b0109805 pbrook
            case 3: gen_revsh(tmp); break;
8879 9ee6e8bb pbrook
            default: goto illegal_op;
8880 9ee6e8bb pbrook
            }
8881 b0109805 pbrook
            store_reg(s, rd, tmp);
8882 9ee6e8bb pbrook
            break;
8883 9ee6e8bb pbrook
8884 9ee6e8bb pbrook
        case 6: /* cps */
8885 9ee6e8bb pbrook
            ARCH(6);
8886 9ee6e8bb pbrook
            if (IS_USER(s))
8887 9ee6e8bb pbrook
                break;
8888 9ee6e8bb pbrook
            if (IS_M(env)) {
8889 8984bd2e pbrook
                tmp = tcg_const_i32((insn & (1 << 4)) != 0);
8890 9ee6e8bb pbrook
                /* PRIMASK */
8891 8984bd2e pbrook
                if (insn & 1) {
8892 8984bd2e pbrook
                    addr = tcg_const_i32(16);
8893 8984bd2e pbrook
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
8894 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i32(addr);
8895 8984bd2e pbrook
                }
8896 9ee6e8bb pbrook
                /* FAULTMASK */
8897 8984bd2e pbrook
                if (insn & 2) {
8898 8984bd2e pbrook
                    addr = tcg_const_i32(17);
8899 8984bd2e pbrook
                    gen_helper_v7m_msr(cpu_env, addr, tmp);
8900 b75263d6 Juha Riihimรคki
                    tcg_temp_free_i32(addr);
8901 8984bd2e pbrook
                }
8902 b75263d6 Juha Riihimรคki
                tcg_temp_free_i32(tmp);
8903 9ee6e8bb pbrook
                gen_lookup_tb(s);
8904 9ee6e8bb pbrook
            } else {
8905 9ee6e8bb pbrook
                if (insn & (1 << 4))
8906 9ee6e8bb pbrook
                    shift = CPSR_A | CPSR_I | CPSR_F;
8907 9ee6e8bb pbrook
                else
8908 9ee6e8bb pbrook
                    shift = 0;
8909 fa26df03 Rabin Vincent
                gen_set_psr_im(s, ((insn & 7) << 6), 0, shift);
8910 9ee6e8bb pbrook
            }
8911 9ee6e8bb pbrook
            break;
8912 9ee6e8bb pbrook
8913 99c475ab bellard
        default:
8914 99c475ab bellard
            goto undef;
8915 99c475ab bellard
        }
8916 99c475ab bellard
        break;
8917 99c475ab bellard
8918 99c475ab bellard
    case 12:
8919 99c475ab bellard
        /* load/store multiple */
8920 99c475ab bellard
        rn = (insn >> 8) & 0x7;
8921 b0109805 pbrook
        addr = load_reg(s, rn);
8922 99c475ab bellard
        for (i = 0; i < 8; i++) {
8923 99c475ab bellard
            if (insn & (1 << i)) {
8924 99c475ab bellard
                if (insn & (1 << 11)) {
8925 99c475ab bellard
                    /* load */
8926 b0109805 pbrook
                    tmp = gen_ld32(addr, IS_USER(s));
8927 b0109805 pbrook
                    store_reg(s, i, tmp);
8928 99c475ab bellard
                } else {
8929 99c475ab bellard
                    /* store */
8930 b0109805 pbrook
                    tmp = load_reg(s, i);
8931 b0109805 pbrook
                    gen_st32(tmp, addr, IS_USER(s));
8932 99c475ab bellard
                }
8933 5899f386 bellard
                /* advance to the next address */
8934 b0109805 pbrook
                tcg_gen_addi_i32(addr, addr, 4);
8935 99c475ab bellard
            }
8936 99c475ab bellard
        }
8937 5899f386 bellard
        /* Base register writeback.  */
8938 b0109805 pbrook
        if ((insn & (1 << rn)) == 0) {
8939 b0109805 pbrook
            store_reg(s, rn, addr);
8940 b0109805 pbrook
        } else {
8941 b0109805 pbrook
            dead_tmp(addr);
8942 b0109805 pbrook
        }
8943 99c475ab bellard
        break;
8944 99c475ab bellard
8945 99c475ab bellard
    case 13:
8946 99c475ab bellard
        /* conditional branch or swi */
8947 99c475ab bellard
        cond = (insn >> 8) & 0xf;
8948 99c475ab bellard
        if (cond == 0xe)
8949 99c475ab bellard
            goto undef;
8950 99c475ab bellard
8951 99c475ab bellard
        if (cond == 0xf) {
8952 99c475ab bellard
            /* swi */
8953 9ee6e8bb pbrook
            gen_set_condexec(s);
8954 422ebf69 balrog
            gen_set_pc_im(s->pc);
8955 9ee6e8bb pbrook
            s->is_jmp = DISAS_SWI;
8956 99c475ab bellard
            break;
8957 99c475ab bellard
        }
8958 99c475ab bellard
        /* generate a conditional jump to next instruction */
8959 e50e6a20 bellard
        s->condlabel = gen_new_label();
8960 d9ba4830 pbrook
        gen_test_cc(cond ^ 1, s->condlabel);
8961 e50e6a20 bellard
        s->condjmp = 1;
8962 99c475ab bellard
8963 99c475ab bellard
        /* jump to the offset */
8964 5899f386 bellard
        val = (uint32_t)s->pc + 2;
8965 99c475ab bellard
        offset = ((int32_t)insn << 24) >> 24;
8966 5899f386 bellard
        val += offset << 1;
8967 8aaca4c0 bellard
        gen_jmp(s, val);
8968 99c475ab bellard
        break;
8969 99c475ab bellard
8970 99c475ab bellard
    case 14:
8971 358bf29e pbrook
        if (insn & (1 << 11)) {
8972 9ee6e8bb pbrook
            if (disas_thumb2_insn(env, s, insn))
8973 9ee6e8bb pbrook
              goto undef32;
8974 358bf29e pbrook
            break;
8975 358bf29e pbrook
        }
8976 9ee6e8bb pbrook
        /* unconditional branch */
8977 99c475ab bellard
        val = (uint32_t)s->pc;
8978 99c475ab bellard
        offset = ((int32_t)insn << 21) >> 21;
8979 99c475ab bellard
        val += (offset << 1) + 2;
8980 8aaca4c0 bellard
        gen_jmp(s, val);
8981 99c475ab bellard
        break;
8982 99c475ab bellard
8983 99c475ab bellard
    case 15:
8984 9ee6e8bb pbrook
        if (disas_thumb2_insn(env, s, insn))
8985 6a0d8a1d balrog
            goto undef32;
8986 9ee6e8bb pbrook
        break;
8987 99c475ab bellard
    }
8988 99c475ab bellard
    return;
8989 9ee6e8bb pbrook
undef32:
8990 9ee6e8bb pbrook
    gen_set_condexec(s);
8991 5e3f878a pbrook
    gen_set_pc_im(s->pc - 4);
8992 d9ba4830 pbrook
    gen_exception(EXCP_UDEF);
8993 9ee6e8bb pbrook
    s->is_jmp = DISAS_JUMP;
8994 9ee6e8bb pbrook
    return;
8995 9ee6e8bb pbrook
illegal_op:
8996 99c475ab bellard
undef:
8997 9ee6e8bb pbrook
    gen_set_condexec(s);
8998 5e3f878a pbrook
    gen_set_pc_im(s->pc - 2);
8999 d9ba4830 pbrook
    gen_exception(EXCP_UDEF);
9000 99c475ab bellard
    s->is_jmp = DISAS_JUMP;
9001 99c475ab bellard
}
9002 99c475ab bellard
9003 2c0262af bellard
/* generate intermediate code in gen_opc_buf and gen_opparam_buf for
9004 2c0262af bellard
   basic block 'tb'. If search_pc is TRUE, also generate PC
9005 2c0262af bellard
   information for each intermediate instruction. */
9006 2cfc5f17 ths
static inline void gen_intermediate_code_internal(CPUState *env,
9007 2cfc5f17 ths
                                                  TranslationBlock *tb,
9008 2cfc5f17 ths
                                                  int search_pc)
9009 2c0262af bellard
{
9010 2c0262af bellard
    DisasContext dc1, *dc = &dc1;
9011 a1d1bb31 aliguori
    CPUBreakpoint *bp;
9012 2c0262af bellard
    uint16_t *gen_opc_end;
9013 2c0262af bellard
    int j, lj;
9014 0fa85d43 bellard
    target_ulong pc_start;
9015 b5ff1b31 bellard
    uint32_t next_page_start;
9016 2e70f6ef pbrook
    int num_insns;
9017 2e70f6ef pbrook
    int max_insns;
9018 3b46e624 ths
9019 2c0262af bellard
    /* generate intermediate code */
9020 b26eefb6 pbrook
    num_temps = 0;
9021 b26eefb6 pbrook
9022 0fa85d43 bellard
    pc_start = tb->pc;
9023 3b46e624 ths
9024 2c0262af bellard
    dc->tb = tb;
9025 2c0262af bellard
9026 2c0262af bellard
    gen_opc_end = gen_opc_buf + OPC_MAX_SIZE;
9027 2c0262af bellard
9028 2c0262af bellard
    dc->is_jmp = DISAS_NEXT;
9029 2c0262af bellard
    dc->pc = pc_start;
9030 8aaca4c0 bellard
    dc->singlestep_enabled = env->singlestep_enabled;
9031 e50e6a20 bellard
    dc->condjmp = 0;
9032 5899f386 bellard
    dc->thumb = env->thumb;
9033 9ee6e8bb pbrook
    dc->condexec_mask = (env->condexec_bits & 0xf) << 1;
9034 9ee6e8bb pbrook
    dc->condexec_cond = env->condexec_bits >> 4;
9035 b5ff1b31 bellard
#if !defined(CONFIG_USER_ONLY)
9036 9ee6e8bb pbrook
    if (IS_M(env)) {
9037 9ee6e8bb pbrook
        dc->user = ((env->v7m.exception == 0) && (env->v7m.control & 1));
9038 9ee6e8bb pbrook
    } else {
9039 9ee6e8bb pbrook
        dc->user = (env->uncached_cpsr & 0x1f) == ARM_CPU_MODE_USR;
9040 9ee6e8bb pbrook
    }
9041 b5ff1b31 bellard
#endif
9042 a7812ae4 pbrook
    cpu_F0s = tcg_temp_new_i32();
9043 a7812ae4 pbrook
    cpu_F1s = tcg_temp_new_i32();
9044 a7812ae4 pbrook
    cpu_F0d = tcg_temp_new_i64();
9045 a7812ae4 pbrook
    cpu_F1d = tcg_temp_new_i64();
9046 ad69471c pbrook
    cpu_V0 = cpu_F0d;
9047 ad69471c pbrook
    cpu_V1 = cpu_F1d;
9048 e677137d pbrook
    /* FIXME: cpu_M0 can probably be the same as cpu_V0.  */
9049 a7812ae4 pbrook
    cpu_M0 = tcg_temp_new_i64();
9050 b5ff1b31 bellard
    next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
9051 2c0262af bellard
    lj = -1;
9052 2e70f6ef pbrook
    num_insns = 0;
9053 2e70f6ef pbrook
    max_insns = tb->cflags & CF_COUNT_MASK;
9054 2e70f6ef pbrook
    if (max_insns == 0)
9055 2e70f6ef pbrook
        max_insns = CF_COUNT_MASK;
9056 2e70f6ef pbrook
9057 2e70f6ef pbrook
    gen_icount_start();
9058 9ee6e8bb pbrook
    /* Reset the conditional execution bits immediately. This avoids
9059 9ee6e8bb pbrook
       complications trying to do it at the end of the block.  */
9060 9ee6e8bb pbrook
    if (env->condexec_bits)
9061 8f01245e pbrook
      {
9062 8f01245e pbrook
        TCGv tmp = new_tmp();
9063 8f01245e pbrook
        tcg_gen_movi_i32(tmp, 0);
9064 d9ba4830 pbrook
        store_cpu_field(tmp, condexec_bits);
9065 8f01245e pbrook
      }
9066 2c0262af bellard
    do {
9067 fbb4a2e3 pbrook
#ifdef CONFIG_USER_ONLY
9068 fbb4a2e3 pbrook
        /* Intercept jump to the magic kernel page.  */
9069 fbb4a2e3 pbrook
        if (dc->pc >= 0xffff0000) {
9070 fbb4a2e3 pbrook
            /* We always get here via a jump, so know we are not in a
9071 fbb4a2e3 pbrook
               conditional execution block.  */
9072 fbb4a2e3 pbrook
            gen_exception(EXCP_KERNEL_TRAP);
9073 fbb4a2e3 pbrook
            dc->is_jmp = DISAS_UPDATE;
9074 fbb4a2e3 pbrook
            break;
9075 fbb4a2e3 pbrook
        }
9076 fbb4a2e3 pbrook
#else
9077 9ee6e8bb pbrook
        if (dc->pc >= 0xfffffff0 && IS_M(env)) {
9078 9ee6e8bb pbrook
            /* We always get here via a jump, so know we are not in a
9079 9ee6e8bb pbrook
               conditional execution block.  */
9080 d9ba4830 pbrook
            gen_exception(EXCP_EXCEPTION_EXIT);
9081 d60bb01c pbrook
            dc->is_jmp = DISAS_UPDATE;
9082 d60bb01c pbrook
            break;
9083 9ee6e8bb pbrook
        }
9084 9ee6e8bb pbrook
#endif
9085 9ee6e8bb pbrook
9086 72cf2d4f Blue Swirl
        if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
9087 72cf2d4f Blue Swirl
            QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
9088 a1d1bb31 aliguori
                if (bp->pc == dc->pc) {
9089 9ee6e8bb pbrook
                    gen_set_condexec(dc);
9090 5e3f878a pbrook
                    gen_set_pc_im(dc->pc);
9091 d9ba4830 pbrook
                    gen_exception(EXCP_DEBUG);
9092 1fddef4b bellard
                    dc->is_jmp = DISAS_JUMP;
9093 9ee6e8bb pbrook
                    /* Advance PC so that clearing the breakpoint will
9094 9ee6e8bb pbrook
                       invalidate this TB.  */
9095 9ee6e8bb pbrook
                    dc->pc += 2;
9096 9ee6e8bb pbrook
                    goto done_generating;
9097 1fddef4b bellard
                    break;
9098 1fddef4b bellard
                }
9099 1fddef4b bellard
            }
9100 1fddef4b bellard
        }
9101 2c0262af bellard
        if (search_pc) {
9102 2c0262af bellard
            j = gen_opc_ptr - gen_opc_buf;
9103 2c0262af bellard
            if (lj < j) {
9104 2c0262af bellard
                lj++;
9105 2c0262af bellard
                while (lj < j)
9106 2c0262af bellard
                    gen_opc_instr_start[lj++] = 0;
9107 2c0262af bellard
            }
9108 0fa85d43 bellard
            gen_opc_pc[lj] = dc->pc;
9109 2c0262af bellard
            gen_opc_instr_start[lj] = 1;
9110 2e70f6ef pbrook
            gen_opc_icount[lj] = num_insns;
9111 2c0262af bellard
        }
9112 e50e6a20 bellard
9113 2e70f6ef pbrook
        if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO))
9114 2e70f6ef pbrook
            gen_io_start();
9115 2e70f6ef pbrook
9116 9ee6e8bb pbrook
        if (env->thumb) {
9117 9ee6e8bb pbrook
            disas_thumb_insn(env, dc);
9118 9ee6e8bb pbrook
            if (dc->condexec_mask) {
9119 9ee6e8bb pbrook
                dc->condexec_cond = (dc->condexec_cond & 0xe)
9120 9ee6e8bb pbrook
                                   | ((dc->condexec_mask >> 4) & 1);
9121 9ee6e8bb pbrook
                dc->condexec_mask = (dc->condexec_mask << 1) & 0x1f;
9122 9ee6e8bb pbrook
                if (dc->condexec_mask == 0) {
9123 9ee6e8bb pbrook
                    dc->condexec_cond = 0;
9124 9ee6e8bb pbrook
                }
9125 9ee6e8bb pbrook
            }
9126 9ee6e8bb pbrook
        } else {
9127 9ee6e8bb pbrook
            disas_arm_insn(env, dc);
9128 9ee6e8bb pbrook
        }
9129 b26eefb6 pbrook
        if (num_temps) {
9130 b26eefb6 pbrook
            fprintf(stderr, "Internal resource leak before %08x\n", dc->pc);
9131 b26eefb6 pbrook
            num_temps = 0;
9132 b26eefb6 pbrook
        }
9133 e50e6a20 bellard
9134 e50e6a20 bellard
        if (dc->condjmp && !dc->is_jmp) {
9135 e50e6a20 bellard
            gen_set_label(dc->condlabel);
9136 e50e6a20 bellard
            dc->condjmp = 0;
9137 e50e6a20 bellard
        }
9138 aaf2d97d balrog
        /* Translation stops when a conditional branch is encountered.
9139 e50e6a20 bellard
         * Otherwise the subsequent code could get translated several times.
9140 b5ff1b31 bellard
         * Also stop translation when a page boundary is reached.  This
9141 bf20dc07 ths
         * ensures prefetch aborts occur at the right place.  */
9142 2e70f6ef pbrook
        num_insns ++;
9143 1fddef4b bellard
    } while (!dc->is_jmp && gen_opc_ptr < gen_opc_end &&
9144 1fddef4b bellard
             !env->singlestep_enabled &&
9145 1b530a6d aurel32
             !singlestep &&
9146 2e70f6ef pbrook
             dc->pc < next_page_start &&
9147 2e70f6ef pbrook
             num_insns < max_insns);
9148 2e70f6ef pbrook
9149 2e70f6ef pbrook
    if (tb->cflags & CF_LAST_IO) {
9150 2e70f6ef pbrook
        if (dc->condjmp) {
9151 2e70f6ef pbrook
            /* FIXME:  This can theoretically happen with self-modifying
9152 2e70f6ef pbrook
               code.  */
9153 2e70f6ef pbrook
            cpu_abort(env, "IO on conditional branch instruction");
9154 2e70f6ef pbrook
        }
9155 2e70f6ef pbrook
        gen_io_end();
9156 2e70f6ef pbrook
    }
9157 9ee6e8bb pbrook
9158 b5ff1b31 bellard
    /* At this stage dc->condjmp will only be set when the skipped
9159 9ee6e8bb pbrook
       instruction was a conditional branch or trap, and the PC has
9160 9ee6e8bb pbrook
       already been written.  */
9161 551bd27f ths
    if (unlikely(env->singlestep_enabled)) {
9162 8aaca4c0 bellard
        /* Make sure the pc is updated, and raise a debug exception.  */
9163 e50e6a20 bellard
        if (dc->condjmp) {
9164 9ee6e8bb pbrook
            gen_set_condexec(dc);
9165 9ee6e8bb pbrook
            if (dc->is_jmp == DISAS_SWI) {
9166 d9ba4830 pbrook
                gen_exception(EXCP_SWI);
9167 9ee6e8bb pbrook
            } else {
9168 d9ba4830 pbrook
                gen_exception(EXCP_DEBUG);
9169 9ee6e8bb pbrook
            }
9170 e50e6a20 bellard
            gen_set_label(dc->condlabel);
9171 e50e6a20 bellard
        }
9172 e50e6a20 bellard
        if (dc->condjmp || !dc->is_jmp) {
9173 5e3f878a pbrook
            gen_set_pc_im(dc->pc);
9174 e50e6a20 bellard
            dc->condjmp = 0;
9175 8aaca4c0 bellard
        }
9176 9ee6e8bb pbrook
        gen_set_condexec(dc);
9177 9ee6e8bb pbrook
        if (dc->is_jmp == DISAS_SWI && !dc->condjmp) {
9178 d9ba4830 pbrook
            gen_exception(EXCP_SWI);
9179 9ee6e8bb pbrook
        } else {
9180 9ee6e8bb pbrook
            /* FIXME: Single stepping a WFI insn will not halt
9181 9ee6e8bb pbrook
               the CPU.  */
9182 d9ba4830 pbrook
            gen_exception(EXCP_DEBUG);
9183 9ee6e8bb pbrook
        }
9184 8aaca4c0 bellard
    } else {
9185 9ee6e8bb pbrook
        /* While branches must always occur at the end of an IT block,
9186 9ee6e8bb pbrook
           there are a few other things that can cause us to terminate
9187 9ee6e8bb pbrook
           the TB in the middel of an IT block:
9188 9ee6e8bb pbrook
            - Exception generating instructions (bkpt, swi, undefined).
9189 9ee6e8bb pbrook
            - Page boundaries.
9190 9ee6e8bb pbrook
            - Hardware watchpoints.
9191 9ee6e8bb pbrook
           Hardware breakpoints have already been handled and skip this code.
9192 9ee6e8bb pbrook
         */
9193 9ee6e8bb pbrook
        gen_set_condexec(dc);
9194 8aaca4c0 bellard
        switch(dc->is_jmp) {
9195 8aaca4c0 bellard
        case DISAS_NEXT:
9196 6e256c93 bellard
            gen_goto_tb(dc, 1, dc->pc);
9197 8aaca4c0 bellard
            break;
9198 8aaca4c0 bellard
        default:
9199 8aaca4c0 bellard
        case DISAS_JUMP:
9200 8aaca4c0 bellard
        case DISAS_UPDATE:
9201 8aaca4c0 bellard
            /* indicate that the hash table must be used to find the next TB */
9202 57fec1fe bellard
            tcg_gen_exit_tb(0);
9203 8aaca4c0 bellard
            break;
9204 8aaca4c0 bellard
        case DISAS_TB_JUMP:
9205 8aaca4c0 bellard
            /* nothing more to generate */
9206 8aaca4c0 bellard
            break;
9207 9ee6e8bb pbrook
        case DISAS_WFI:
9208 d9ba4830 pbrook
            gen_helper_wfi();
9209 9ee6e8bb pbrook
            break;
9210 9ee6e8bb pbrook
        case DISAS_SWI:
9211 d9ba4830 pbrook
            gen_exception(EXCP_SWI);
9212 9ee6e8bb pbrook
            break;
9213 8aaca4c0 bellard
        }
9214 e50e6a20 bellard
        if (dc->condjmp) {
9215 e50e6a20 bellard
            gen_set_label(dc->condlabel);
9216 9ee6e8bb pbrook
            gen_set_condexec(dc);
9217 6e256c93 bellard
            gen_goto_tb(dc, 1, dc->pc);
9218 e50e6a20 bellard
            dc->condjmp = 0;
9219 e50e6a20 bellard
        }
9220 2c0262af bellard
    }
9221 2e70f6ef pbrook
9222 9ee6e8bb pbrook
done_generating:
9223 2e70f6ef pbrook
    gen_icount_end(tb, num_insns);
9224 2c0262af bellard
    *gen_opc_ptr = INDEX_op_end;
9225 2c0262af bellard
9226 2c0262af bellard
#ifdef DEBUG_DISAS
9227 8fec2b8c aliguori
    if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
9228 93fcfe39 aliguori
        qemu_log("----------------\n");
9229 93fcfe39 aliguori
        qemu_log("IN: %s\n", lookup_symbol(pc_start));
9230 93fcfe39 aliguori
        log_target_disas(pc_start, dc->pc - pc_start, env->thumb);
9231 93fcfe39 aliguori
        qemu_log("\n");
9232 2c0262af bellard
    }
9233 2c0262af bellard
#endif
9234 b5ff1b31 bellard
    if (search_pc) {
9235 b5ff1b31 bellard
        j = gen_opc_ptr - gen_opc_buf;
9236 b5ff1b31 bellard
        lj++;
9237 b5ff1b31 bellard
        while (lj <= j)
9238 b5ff1b31 bellard
            gen_opc_instr_start[lj++] = 0;
9239 b5ff1b31 bellard
    } else {
9240 2c0262af bellard
        tb->size = dc->pc - pc_start;
9241 2e70f6ef pbrook
        tb->icount = num_insns;
9242 b5ff1b31 bellard
    }
9243 2c0262af bellard
}
9244 2c0262af bellard
9245 2cfc5f17 ths
void gen_intermediate_code(CPUState *env, TranslationBlock *tb)
9246 2c0262af bellard
{
9247 2cfc5f17 ths
    gen_intermediate_code_internal(env, tb, 0);
9248 2c0262af bellard
}
9249 2c0262af bellard
9250 2cfc5f17 ths
void gen_intermediate_code_pc(CPUState *env, TranslationBlock *tb)
9251 2c0262af bellard
{
9252 2cfc5f17 ths
    gen_intermediate_code_internal(env, tb, 1);
9253 2c0262af bellard
}
9254 2c0262af bellard
9255 b5ff1b31 bellard
static const char *cpu_mode_names[16] = {
9256 b5ff1b31 bellard
  "usr", "fiq", "irq", "svc", "???", "???", "???", "abt",
9257 b5ff1b31 bellard
  "???", "???", "???", "und", "???", "???", "???", "sys"
9258 b5ff1b31 bellard
};
9259 9ee6e8bb pbrook
9260 5fafdf24 ths
void cpu_dump_state(CPUState *env, FILE *f,
9261 7fe48483 bellard
                    int (*cpu_fprintf)(FILE *f, const char *fmt, ...),
9262 7fe48483 bellard
                    int flags)
9263 2c0262af bellard
{
9264 2c0262af bellard
    int i;
9265 06e80fc9 ths
#if 0
9266 bc380d17 bellard
    union {
9267 b7bcbe95 bellard
        uint32_t i;
9268 b7bcbe95 bellard
        float s;
9269 b7bcbe95 bellard
    } s0, s1;
9270 b7bcbe95 bellard
    CPU_DoubleU d;
9271 a94a6abf pbrook
    /* ??? This assumes float64 and double have the same layout.
9272 a94a6abf pbrook
       Oh well, it's only debug dumps.  */
9273 a94a6abf pbrook
    union {
9274 a94a6abf pbrook
        float64 f64;
9275 a94a6abf pbrook
        double d;
9276 a94a6abf pbrook
    } d0;
9277 06e80fc9 ths
#endif
9278 b5ff1b31 bellard
    uint32_t psr;
9279 2c0262af bellard
9280 2c0262af bellard
    for(i=0;i<16;i++) {
9281 7fe48483 bellard
        cpu_fprintf(f, "R%02d=%08x", i, env->regs[i]);
9282 2c0262af bellard
        if ((i % 4) == 3)
9283 7fe48483 bellard
            cpu_fprintf(f, "\n");
9284 2c0262af bellard
        else
9285 7fe48483 bellard
            cpu_fprintf(f, " ");
9286 2c0262af bellard
    }
9287 b5ff1b31 bellard
    psr = cpsr_read(env);
9288 687fa640 ths
    cpu_fprintf(f, "PSR=%08x %c%c%c%c %c %s%d\n",
9289 687fa640 ths
                psr,
9290 b5ff1b31 bellard
                psr & (1 << 31) ? 'N' : '-',
9291 b5ff1b31 bellard
                psr & (1 << 30) ? 'Z' : '-',
9292 b5ff1b31 bellard
                psr & (1 << 29) ? 'C' : '-',
9293 b5ff1b31 bellard
                psr & (1 << 28) ? 'V' : '-',
9294 5fafdf24 ths
                psr & CPSR_T ? 'T' : 'A',
9295 b5ff1b31 bellard
                cpu_mode_names[psr & 0xf], (psr & 0x10) ? 32 : 26);
9296 b7bcbe95 bellard
9297 5e3f878a pbrook
#if 0
9298 b7bcbe95 bellard
    for (i = 0; i < 16; i++) {
9299 8e96005d bellard
        d.d = env->vfp.regs[i];
9300 8e96005d bellard
        s0.i = d.l.lower;
9301 8e96005d bellard
        s1.i = d.l.upper;
9302 a94a6abf pbrook
        d0.f64 = d.d;
9303 a94a6abf pbrook
        cpu_fprintf(f, "s%02d=%08x(%8g) s%02d=%08x(%8g) d%02d=%08x%08x(%8g)\n",
9304 b7bcbe95 bellard
                    i * 2, (int)s0.i, s0.s,
9305 a94a6abf pbrook
                    i * 2 + 1, (int)s1.i, s1.s,
9306 b7bcbe95 bellard
                    i, (int)(uint32_t)d.l.upper, (int)(uint32_t)d.l.lower,
9307 a94a6abf pbrook
                    d0.d);
9308 b7bcbe95 bellard
    }
9309 40f137e1 pbrook
    cpu_fprintf(f, "FPSCR: %08x\n", (int)env->vfp.xregs[ARM_VFP_FPSCR]);
9310 5e3f878a pbrook
#endif
9311 2c0262af bellard
}
9312 a6b025d3 bellard
9313 d2856f1a aurel32
void gen_pc_load(CPUState *env, TranslationBlock *tb,
9314 d2856f1a aurel32
                unsigned long searched_pc, int pc_pos, void *puc)
9315 d2856f1a aurel32
{
9316 d2856f1a aurel32
    env->regs[15] = gen_opc_pc[pc_pos];
9317 d2856f1a aurel32
}