xref: /openbmc/qemu/target/microblaze/translate.c (revision 2023e9a3bcb514a5fd41644c63825109c286e4ef)
1fcf5ef2aSThomas Huth /*
2fcf5ef2aSThomas Huth  *  Xilinx MicroBlaze emulation for qemu: main translation routines.
3fcf5ef2aSThomas Huth  *
4fcf5ef2aSThomas Huth  *  Copyright (c) 2009 Edgar E. Iglesias.
5fcf5ef2aSThomas Huth  *  Copyright (c) 2009-2012 PetaLogix Qld Pty Ltd.
6fcf5ef2aSThomas Huth  *
7fcf5ef2aSThomas Huth  * This library is free software; you can redistribute it and/or
8fcf5ef2aSThomas Huth  * modify it under the terms of the GNU Lesser General Public
9fcf5ef2aSThomas Huth  * License as published by the Free Software Foundation; either
10fcf5ef2aSThomas Huth  * version 2 of the License, or (at your option) any later version.
11fcf5ef2aSThomas Huth  *
12fcf5ef2aSThomas Huth  * This library is distributed in the hope that it will be useful,
13fcf5ef2aSThomas Huth  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14fcf5ef2aSThomas Huth  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15fcf5ef2aSThomas Huth  * Lesser General Public License for more details.
16fcf5ef2aSThomas Huth  *
17fcf5ef2aSThomas Huth  * You should have received a copy of the GNU Lesser General Public
18fcf5ef2aSThomas Huth  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
19fcf5ef2aSThomas Huth  */
20fcf5ef2aSThomas Huth 
21fcf5ef2aSThomas Huth #include "qemu/osdep.h"
22fcf5ef2aSThomas Huth #include "cpu.h"
23fcf5ef2aSThomas Huth #include "disas/disas.h"
24fcf5ef2aSThomas Huth #include "exec/exec-all.h"
25fcf5ef2aSThomas Huth #include "tcg-op.h"
26fcf5ef2aSThomas Huth #include "exec/helper-proto.h"
27fcf5ef2aSThomas Huth #include "microblaze-decode.h"
28fcf5ef2aSThomas Huth #include "exec/cpu_ldst.h"
29fcf5ef2aSThomas Huth #include "exec/helper-gen.h"
3077fc6f5eSLluís Vilanova #include "exec/translator.h"
31fcf5ef2aSThomas Huth 
32fcf5ef2aSThomas Huth #include "trace-tcg.h"
33fcf5ef2aSThomas Huth #include "exec/log.h"
34fcf5ef2aSThomas Huth 
35fcf5ef2aSThomas Huth 
36fcf5ef2aSThomas Huth #define SIM_COMPAT 0
37fcf5ef2aSThomas Huth #define DISAS_GNU 1
38fcf5ef2aSThomas Huth #define DISAS_MB 1
39fcf5ef2aSThomas Huth #if DISAS_MB && !SIM_COMPAT
40fcf5ef2aSThomas Huth #  define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
41fcf5ef2aSThomas Huth #else
42fcf5ef2aSThomas Huth #  define LOG_DIS(...) do { } while (0)
43fcf5ef2aSThomas Huth #endif
44fcf5ef2aSThomas Huth 
45fcf5ef2aSThomas Huth #define D(x)
46fcf5ef2aSThomas Huth 
47fcf5ef2aSThomas Huth #define EXTRACT_FIELD(src, start, end) \
48fcf5ef2aSThomas Huth             (((src) >> start) & ((1 << (end - start + 1)) - 1))
49fcf5ef2aSThomas Huth 
5077fc6f5eSLluís Vilanova /* is_jmp field values */
5177fc6f5eSLluís Vilanova #define DISAS_JUMP    DISAS_TARGET_0 /* only pc was modified dynamically */
5277fc6f5eSLluís Vilanova #define DISAS_UPDATE  DISAS_TARGET_1 /* cpu state was modified dynamically */
5377fc6f5eSLluís Vilanova #define DISAS_TB_JUMP DISAS_TARGET_2 /* only pc was modified statically */
5477fc6f5eSLluís Vilanova 
55cfeea807SEdgar E. Iglesias static TCGv_i32 env_debug;
56cfeea807SEdgar E. Iglesias static TCGv_i32 cpu_R[32];
57cfeea807SEdgar E. Iglesias static TCGv_i32 cpu_SR[14];
58cfeea807SEdgar E. Iglesias static TCGv_i32 env_imm;
59cfeea807SEdgar E. Iglesias static TCGv_i32 env_btaken;
60cfeea807SEdgar E. Iglesias static TCGv_i32 env_btarget;
61cfeea807SEdgar E. Iglesias static TCGv_i32 env_iflags;
62403322eaSEdgar E. Iglesias static TCGv env_res_addr;
63cfeea807SEdgar E. Iglesias static TCGv_i32 env_res_val;
64fcf5ef2aSThomas Huth 
65fcf5ef2aSThomas Huth #include "exec/gen-icount.h"
66fcf5ef2aSThomas Huth 
67fcf5ef2aSThomas Huth /* This is the state at translation time.  */
68fcf5ef2aSThomas Huth typedef struct DisasContext {
69fcf5ef2aSThomas Huth     MicroBlazeCPU *cpu;
70cfeea807SEdgar E. Iglesias     uint32_t pc;
71fcf5ef2aSThomas Huth 
72fcf5ef2aSThomas Huth     /* Decoder.  */
73fcf5ef2aSThomas Huth     int type_b;
74fcf5ef2aSThomas Huth     uint32_t ir;
75fcf5ef2aSThomas Huth     uint8_t opcode;
76fcf5ef2aSThomas Huth     uint8_t rd, ra, rb;
77fcf5ef2aSThomas Huth     uint16_t imm;
78fcf5ef2aSThomas Huth 
79fcf5ef2aSThomas Huth     unsigned int cpustate_changed;
80fcf5ef2aSThomas Huth     unsigned int delayed_branch;
81fcf5ef2aSThomas Huth     unsigned int tb_flags, synced_flags; /* tb dependent flags.  */
82fcf5ef2aSThomas Huth     unsigned int clear_imm;
83fcf5ef2aSThomas Huth     int is_jmp;
84fcf5ef2aSThomas Huth 
85fcf5ef2aSThomas Huth #define JMP_NOJMP     0
86fcf5ef2aSThomas Huth #define JMP_DIRECT    1
87fcf5ef2aSThomas Huth #define JMP_DIRECT_CC 2
88fcf5ef2aSThomas Huth #define JMP_INDIRECT  3
89fcf5ef2aSThomas Huth     unsigned int jmp;
90fcf5ef2aSThomas Huth     uint32_t jmp_pc;
91fcf5ef2aSThomas Huth 
92fcf5ef2aSThomas Huth     int abort_at_next_insn;
93fcf5ef2aSThomas Huth     int nr_nops;
94fcf5ef2aSThomas Huth     struct TranslationBlock *tb;
95fcf5ef2aSThomas Huth     int singlestep_enabled;
96fcf5ef2aSThomas Huth } DisasContext;
97fcf5ef2aSThomas Huth 
98fcf5ef2aSThomas Huth static const char *regnames[] =
99fcf5ef2aSThomas Huth {
100fcf5ef2aSThomas Huth     "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
101fcf5ef2aSThomas Huth     "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
102fcf5ef2aSThomas Huth     "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
103fcf5ef2aSThomas Huth     "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
104fcf5ef2aSThomas Huth };
105fcf5ef2aSThomas Huth 
106fcf5ef2aSThomas Huth static const char *special_regnames[] =
107fcf5ef2aSThomas Huth {
1080031eef2SEdgar E. Iglesias     "rpc", "rmsr", "sr2", "rear", "sr4", "resr", "sr6", "rfsr",
1090031eef2SEdgar E. Iglesias     "sr8", "sr9", "sr10", "rbtr", "sr12", "redr"
110fcf5ef2aSThomas Huth };
111fcf5ef2aSThomas Huth 
112fcf5ef2aSThomas Huth static inline void t_sync_flags(DisasContext *dc)
113fcf5ef2aSThomas Huth {
114fcf5ef2aSThomas Huth     /* Synch the tb dependent flags between translator and runtime.  */
115fcf5ef2aSThomas Huth     if (dc->tb_flags != dc->synced_flags) {
116cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(env_iflags, dc->tb_flags);
117fcf5ef2aSThomas Huth         dc->synced_flags = dc->tb_flags;
118fcf5ef2aSThomas Huth     }
119fcf5ef2aSThomas Huth }
120fcf5ef2aSThomas Huth 
121fcf5ef2aSThomas Huth static inline void t_gen_raise_exception(DisasContext *dc, uint32_t index)
122fcf5ef2aSThomas Huth {
123fcf5ef2aSThomas Huth     TCGv_i32 tmp = tcg_const_i32(index);
124fcf5ef2aSThomas Huth 
125fcf5ef2aSThomas Huth     t_sync_flags(dc);
126cfeea807SEdgar E. Iglesias     tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc);
127fcf5ef2aSThomas Huth     gen_helper_raise_exception(cpu_env, tmp);
128fcf5ef2aSThomas Huth     tcg_temp_free_i32(tmp);
129fcf5ef2aSThomas Huth     dc->is_jmp = DISAS_UPDATE;
130fcf5ef2aSThomas Huth }
131fcf5ef2aSThomas Huth 
132fcf5ef2aSThomas Huth static inline bool use_goto_tb(DisasContext *dc, target_ulong dest)
133fcf5ef2aSThomas Huth {
134fcf5ef2aSThomas Huth #ifndef CONFIG_USER_ONLY
135fcf5ef2aSThomas Huth     return (dc->tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK);
136fcf5ef2aSThomas Huth #else
137fcf5ef2aSThomas Huth     return true;
138fcf5ef2aSThomas Huth #endif
139fcf5ef2aSThomas Huth }
140fcf5ef2aSThomas Huth 
141fcf5ef2aSThomas Huth static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest)
142fcf5ef2aSThomas Huth {
143fcf5ef2aSThomas Huth     if (use_goto_tb(dc, dest)) {
144fcf5ef2aSThomas Huth         tcg_gen_goto_tb(n);
145cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], dest);
146fcf5ef2aSThomas Huth         tcg_gen_exit_tb((uintptr_t)dc->tb + n);
147fcf5ef2aSThomas Huth     } else {
148cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], dest);
149fcf5ef2aSThomas Huth         tcg_gen_exit_tb(0);
150fcf5ef2aSThomas Huth     }
151fcf5ef2aSThomas Huth }
152fcf5ef2aSThomas Huth 
153cfeea807SEdgar E. Iglesias static void read_carry(DisasContext *dc, TCGv_i32 d)
154fcf5ef2aSThomas Huth {
155cfeea807SEdgar E. Iglesias     tcg_gen_shri_i32(d, cpu_SR[SR_MSR], 31);
156fcf5ef2aSThomas Huth }
157fcf5ef2aSThomas Huth 
158fcf5ef2aSThomas Huth /*
159fcf5ef2aSThomas Huth  * write_carry sets the carry bits in MSR based on bit 0 of v.
160fcf5ef2aSThomas Huth  * v[31:1] are ignored.
161fcf5ef2aSThomas Huth  */
162cfeea807SEdgar E. Iglesias static void write_carry(DisasContext *dc, TCGv_i32 v)
163fcf5ef2aSThomas Huth {
164cfeea807SEdgar E. Iglesias     TCGv_i32 t0 = tcg_temp_new_i32();
165cfeea807SEdgar E. Iglesias     tcg_gen_shli_i32(t0, v, 31);
166cfeea807SEdgar E. Iglesias     tcg_gen_sari_i32(t0, t0, 31);
167cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t0, t0, (MSR_C | MSR_CC));
168cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR],
169fcf5ef2aSThomas Huth                     ~(MSR_C | MSR_CC));
170cfeea807SEdgar E. Iglesias     tcg_gen_or_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t0);
171cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t0);
172fcf5ef2aSThomas Huth }
173fcf5ef2aSThomas Huth 
174fcf5ef2aSThomas Huth static void write_carryi(DisasContext *dc, bool carry)
175fcf5ef2aSThomas Huth {
176cfeea807SEdgar E. Iglesias     TCGv_i32 t0 = tcg_temp_new_i32();
177cfeea807SEdgar E. Iglesias     tcg_gen_movi_i32(t0, carry);
178fcf5ef2aSThomas Huth     write_carry(dc, t0);
179cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t0);
180fcf5ef2aSThomas Huth }
181fcf5ef2aSThomas Huth 
182bdfc1e88SEdgar E. Iglesias /*
1839ba8cd45SEdgar E. Iglesias  * Returns true if the insn an illegal operation.
1849ba8cd45SEdgar E. Iglesias  * If exceptions are enabled, an exception is raised.
1859ba8cd45SEdgar E. Iglesias  */
1869ba8cd45SEdgar E. Iglesias static bool trap_illegal(DisasContext *dc, bool cond)
1879ba8cd45SEdgar E. Iglesias {
1889ba8cd45SEdgar E. Iglesias     if (cond && (dc->tb_flags & MSR_EE_FLAG)
1899ba8cd45SEdgar E. Iglesias         && (dc->cpu->env.pvr.regs[2] & PVR2_ILL_OPCODE_EXC_MASK)) {
1909ba8cd45SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_ILLEGAL_OP);
1919ba8cd45SEdgar E. Iglesias         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1929ba8cd45SEdgar E. Iglesias     }
1939ba8cd45SEdgar E. Iglesias     return cond;
1949ba8cd45SEdgar E. Iglesias }
1959ba8cd45SEdgar E. Iglesias 
1969ba8cd45SEdgar E. Iglesias /*
197bdfc1e88SEdgar E. Iglesias  * Returns true if the insn is illegal in userspace.
198bdfc1e88SEdgar E. Iglesias  * If exceptions are enabled, an exception is raised.
199bdfc1e88SEdgar E. Iglesias  */
200bdfc1e88SEdgar E. Iglesias static bool trap_userspace(DisasContext *dc, bool cond)
201bdfc1e88SEdgar E. Iglesias {
202bdfc1e88SEdgar E. Iglesias     int mem_index = cpu_mmu_index(&dc->cpu->env, false);
203bdfc1e88SEdgar E. Iglesias     bool cond_user = cond && mem_index == MMU_USER_IDX;
204bdfc1e88SEdgar E. Iglesias 
205bdfc1e88SEdgar E. Iglesias     if (cond_user && (dc->tb_flags & MSR_EE_FLAG)) {
206bdfc1e88SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_PRIVINSN);
207bdfc1e88SEdgar E. Iglesias         t_gen_raise_exception(dc, EXCP_HW_EXCP);
208bdfc1e88SEdgar E. Iglesias     }
209bdfc1e88SEdgar E. Iglesias     return cond_user;
210bdfc1e88SEdgar E. Iglesias }
211bdfc1e88SEdgar E. Iglesias 
212fcf5ef2aSThomas Huth /* True if ALU operand b is a small immediate that may deserve
213fcf5ef2aSThomas Huth    faster treatment.  */
214fcf5ef2aSThomas Huth static inline int dec_alu_op_b_is_small_imm(DisasContext *dc)
215fcf5ef2aSThomas Huth {
216fcf5ef2aSThomas Huth     /* Immediate insn without the imm prefix ?  */
217fcf5ef2aSThomas Huth     return dc->type_b && !(dc->tb_flags & IMM_FLAG);
218fcf5ef2aSThomas Huth }
219fcf5ef2aSThomas Huth 
220cfeea807SEdgar E. Iglesias static inline TCGv_i32 *dec_alu_op_b(DisasContext *dc)
221fcf5ef2aSThomas Huth {
222fcf5ef2aSThomas Huth     if (dc->type_b) {
223fcf5ef2aSThomas Huth         if (dc->tb_flags & IMM_FLAG)
224cfeea807SEdgar E. Iglesias             tcg_gen_ori_i32(env_imm, env_imm, dc->imm);
225fcf5ef2aSThomas Huth         else
226cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(env_imm, (int32_t)((int16_t)dc->imm));
227fcf5ef2aSThomas Huth         return &env_imm;
228fcf5ef2aSThomas Huth     } else
229fcf5ef2aSThomas Huth         return &cpu_R[dc->rb];
230fcf5ef2aSThomas Huth }
231fcf5ef2aSThomas Huth 
232fcf5ef2aSThomas Huth static void dec_add(DisasContext *dc)
233fcf5ef2aSThomas Huth {
234fcf5ef2aSThomas Huth     unsigned int k, c;
235cfeea807SEdgar E. Iglesias     TCGv_i32 cf;
236fcf5ef2aSThomas Huth 
237fcf5ef2aSThomas Huth     k = dc->opcode & 4;
238fcf5ef2aSThomas Huth     c = dc->opcode & 2;
239fcf5ef2aSThomas Huth 
240fcf5ef2aSThomas Huth     LOG_DIS("add%s%s%s r%d r%d r%d\n",
241fcf5ef2aSThomas Huth             dc->type_b ? "i" : "", k ? "k" : "", c ? "c" : "",
242fcf5ef2aSThomas Huth             dc->rd, dc->ra, dc->rb);
243fcf5ef2aSThomas Huth 
244fcf5ef2aSThomas Huth     /* Take care of the easy cases first.  */
245fcf5ef2aSThomas Huth     if (k) {
246fcf5ef2aSThomas Huth         /* k - keep carry, no need to update MSR.  */
247fcf5ef2aSThomas Huth         /* If rd == r0, it's a nop.  */
248fcf5ef2aSThomas Huth         if (dc->rd) {
249cfeea807SEdgar E. Iglesias             tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
250fcf5ef2aSThomas Huth 
251fcf5ef2aSThomas Huth             if (c) {
252fcf5ef2aSThomas Huth                 /* c - Add carry into the result.  */
253cfeea807SEdgar E. Iglesias                 cf = tcg_temp_new_i32();
254fcf5ef2aSThomas Huth 
255fcf5ef2aSThomas Huth                 read_carry(dc, cf);
256cfeea807SEdgar E. Iglesias                 tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf);
257cfeea807SEdgar E. Iglesias                 tcg_temp_free_i32(cf);
258fcf5ef2aSThomas Huth             }
259fcf5ef2aSThomas Huth         }
260fcf5ef2aSThomas Huth         return;
261fcf5ef2aSThomas Huth     }
262fcf5ef2aSThomas Huth 
263fcf5ef2aSThomas Huth     /* From now on, we can assume k is zero.  So we need to update MSR.  */
264fcf5ef2aSThomas Huth     /* Extract carry.  */
265cfeea807SEdgar E. Iglesias     cf = tcg_temp_new_i32();
266fcf5ef2aSThomas Huth     if (c) {
267fcf5ef2aSThomas Huth         read_carry(dc, cf);
268fcf5ef2aSThomas Huth     } else {
269cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cf, 0);
270fcf5ef2aSThomas Huth     }
271fcf5ef2aSThomas Huth 
272fcf5ef2aSThomas Huth     if (dc->rd) {
273cfeea807SEdgar E. Iglesias         TCGv_i32 ncf = tcg_temp_new_i32();
274fcf5ef2aSThomas Huth         gen_helper_carry(ncf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf);
275cfeea807SEdgar E. Iglesias         tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
276cfeea807SEdgar E. Iglesias         tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf);
277fcf5ef2aSThomas Huth         write_carry(dc, ncf);
278cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(ncf);
279fcf5ef2aSThomas Huth     } else {
280fcf5ef2aSThomas Huth         gen_helper_carry(cf, cpu_R[dc->ra], *(dec_alu_op_b(dc)), cf);
281fcf5ef2aSThomas Huth         write_carry(dc, cf);
282fcf5ef2aSThomas Huth     }
283cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(cf);
284fcf5ef2aSThomas Huth }
285fcf5ef2aSThomas Huth 
286fcf5ef2aSThomas Huth static void dec_sub(DisasContext *dc)
287fcf5ef2aSThomas Huth {
288fcf5ef2aSThomas Huth     unsigned int u, cmp, k, c;
289cfeea807SEdgar E. Iglesias     TCGv_i32 cf, na;
290fcf5ef2aSThomas Huth 
291fcf5ef2aSThomas Huth     u = dc->imm & 2;
292fcf5ef2aSThomas Huth     k = dc->opcode & 4;
293fcf5ef2aSThomas Huth     c = dc->opcode & 2;
294fcf5ef2aSThomas Huth     cmp = (dc->imm & 1) && (!dc->type_b) && k;
295fcf5ef2aSThomas Huth 
296fcf5ef2aSThomas Huth     if (cmp) {
297fcf5ef2aSThomas Huth         LOG_DIS("cmp%s r%d, r%d ir=%x\n", u ? "u" : "", dc->rd, dc->ra, dc->ir);
298fcf5ef2aSThomas Huth         if (dc->rd) {
299fcf5ef2aSThomas Huth             if (u)
300fcf5ef2aSThomas Huth                 gen_helper_cmpu(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
301fcf5ef2aSThomas Huth             else
302fcf5ef2aSThomas Huth                 gen_helper_cmp(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
303fcf5ef2aSThomas Huth         }
304fcf5ef2aSThomas Huth         return;
305fcf5ef2aSThomas Huth     }
306fcf5ef2aSThomas Huth 
307fcf5ef2aSThomas Huth     LOG_DIS("sub%s%s r%d, r%d r%d\n",
308fcf5ef2aSThomas Huth              k ? "k" : "",  c ? "c" : "", dc->rd, dc->ra, dc->rb);
309fcf5ef2aSThomas Huth 
310fcf5ef2aSThomas Huth     /* Take care of the easy cases first.  */
311fcf5ef2aSThomas Huth     if (k) {
312fcf5ef2aSThomas Huth         /* k - keep carry, no need to update MSR.  */
313fcf5ef2aSThomas Huth         /* If rd == r0, it's a nop.  */
314fcf5ef2aSThomas Huth         if (dc->rd) {
315cfeea807SEdgar E. Iglesias             tcg_gen_sub_i32(cpu_R[dc->rd], *(dec_alu_op_b(dc)), cpu_R[dc->ra]);
316fcf5ef2aSThomas Huth 
317fcf5ef2aSThomas Huth             if (c) {
318fcf5ef2aSThomas Huth                 /* c - Add carry into the result.  */
319cfeea807SEdgar E. Iglesias                 cf = tcg_temp_new_i32();
320fcf5ef2aSThomas Huth 
321fcf5ef2aSThomas Huth                 read_carry(dc, cf);
322cfeea807SEdgar E. Iglesias                 tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf);
323cfeea807SEdgar E. Iglesias                 tcg_temp_free_i32(cf);
324fcf5ef2aSThomas Huth             }
325fcf5ef2aSThomas Huth         }
326fcf5ef2aSThomas Huth         return;
327fcf5ef2aSThomas Huth     }
328fcf5ef2aSThomas Huth 
329fcf5ef2aSThomas Huth     /* From now on, we can assume k is zero.  So we need to update MSR.  */
330fcf5ef2aSThomas Huth     /* Extract carry. And complement a into na.  */
331cfeea807SEdgar E. Iglesias     cf = tcg_temp_new_i32();
332cfeea807SEdgar E. Iglesias     na = tcg_temp_new_i32();
333fcf5ef2aSThomas Huth     if (c) {
334fcf5ef2aSThomas Huth         read_carry(dc, cf);
335fcf5ef2aSThomas Huth     } else {
336cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cf, 1);
337fcf5ef2aSThomas Huth     }
338fcf5ef2aSThomas Huth 
339fcf5ef2aSThomas Huth     /* d = b + ~a + c. carry defaults to 1.  */
340cfeea807SEdgar E. Iglesias     tcg_gen_not_i32(na, cpu_R[dc->ra]);
341fcf5ef2aSThomas Huth 
342fcf5ef2aSThomas Huth     if (dc->rd) {
343cfeea807SEdgar E. Iglesias         TCGv_i32 ncf = tcg_temp_new_i32();
344fcf5ef2aSThomas Huth         gen_helper_carry(ncf, na, *(dec_alu_op_b(dc)), cf);
345cfeea807SEdgar E. Iglesias         tcg_gen_add_i32(cpu_R[dc->rd], na, *(dec_alu_op_b(dc)));
346cfeea807SEdgar E. Iglesias         tcg_gen_add_i32(cpu_R[dc->rd], cpu_R[dc->rd], cf);
347fcf5ef2aSThomas Huth         write_carry(dc, ncf);
348cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(ncf);
349fcf5ef2aSThomas Huth     } else {
350fcf5ef2aSThomas Huth         gen_helper_carry(cf, na, *(dec_alu_op_b(dc)), cf);
351fcf5ef2aSThomas Huth         write_carry(dc, cf);
352fcf5ef2aSThomas Huth     }
353cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(cf);
354cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(na);
355fcf5ef2aSThomas Huth }
356fcf5ef2aSThomas Huth 
357fcf5ef2aSThomas Huth static void dec_pattern(DisasContext *dc)
358fcf5ef2aSThomas Huth {
359fcf5ef2aSThomas Huth     unsigned int mode;
360fcf5ef2aSThomas Huth 
3619ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) {
3629ba8cd45SEdgar E. Iglesias         return;
363fcf5ef2aSThomas Huth     }
364fcf5ef2aSThomas Huth 
365fcf5ef2aSThomas Huth     mode = dc->opcode & 3;
366fcf5ef2aSThomas Huth     switch (mode) {
367fcf5ef2aSThomas Huth         case 0:
368fcf5ef2aSThomas Huth             /* pcmpbf.  */
369fcf5ef2aSThomas Huth             LOG_DIS("pcmpbf r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
370fcf5ef2aSThomas Huth             if (dc->rd)
371fcf5ef2aSThomas Huth                 gen_helper_pcmpbf(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
372fcf5ef2aSThomas Huth             break;
373fcf5ef2aSThomas Huth         case 2:
374fcf5ef2aSThomas Huth             LOG_DIS("pcmpeq r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
375fcf5ef2aSThomas Huth             if (dc->rd) {
376cfeea807SEdgar E. Iglesias                 tcg_gen_setcond_i32(TCG_COND_EQ, cpu_R[dc->rd],
377fcf5ef2aSThomas Huth                                    cpu_R[dc->ra], cpu_R[dc->rb]);
378fcf5ef2aSThomas Huth             }
379fcf5ef2aSThomas Huth             break;
380fcf5ef2aSThomas Huth         case 3:
381fcf5ef2aSThomas Huth             LOG_DIS("pcmpne r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
382fcf5ef2aSThomas Huth             if (dc->rd) {
383cfeea807SEdgar E. Iglesias                 tcg_gen_setcond_i32(TCG_COND_NE, cpu_R[dc->rd],
384fcf5ef2aSThomas Huth                                    cpu_R[dc->ra], cpu_R[dc->rb]);
385fcf5ef2aSThomas Huth             }
386fcf5ef2aSThomas Huth             break;
387fcf5ef2aSThomas Huth         default:
388fcf5ef2aSThomas Huth             cpu_abort(CPU(dc->cpu),
389fcf5ef2aSThomas Huth                       "unsupported pattern insn opcode=%x\n", dc->opcode);
390fcf5ef2aSThomas Huth             break;
391fcf5ef2aSThomas Huth     }
392fcf5ef2aSThomas Huth }
393fcf5ef2aSThomas Huth 
394fcf5ef2aSThomas Huth static void dec_and(DisasContext *dc)
395fcf5ef2aSThomas Huth {
396fcf5ef2aSThomas Huth     unsigned int not;
397fcf5ef2aSThomas Huth 
398fcf5ef2aSThomas Huth     if (!dc->type_b && (dc->imm & (1 << 10))) {
399fcf5ef2aSThomas Huth         dec_pattern(dc);
400fcf5ef2aSThomas Huth         return;
401fcf5ef2aSThomas Huth     }
402fcf5ef2aSThomas Huth 
403fcf5ef2aSThomas Huth     not = dc->opcode & (1 << 1);
404fcf5ef2aSThomas Huth     LOG_DIS("and%s\n", not ? "n" : "");
405fcf5ef2aSThomas Huth 
406fcf5ef2aSThomas Huth     if (!dc->rd)
407fcf5ef2aSThomas Huth         return;
408fcf5ef2aSThomas Huth 
409fcf5ef2aSThomas Huth     if (not) {
410cfeea807SEdgar E. Iglesias         tcg_gen_andc_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
411fcf5ef2aSThomas Huth     } else
412cfeea807SEdgar E. Iglesias         tcg_gen_and_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
413fcf5ef2aSThomas Huth }
414fcf5ef2aSThomas Huth 
415fcf5ef2aSThomas Huth static void dec_or(DisasContext *dc)
416fcf5ef2aSThomas Huth {
417fcf5ef2aSThomas Huth     if (!dc->type_b && (dc->imm & (1 << 10))) {
418fcf5ef2aSThomas Huth         dec_pattern(dc);
419fcf5ef2aSThomas Huth         return;
420fcf5ef2aSThomas Huth     }
421fcf5ef2aSThomas Huth 
422fcf5ef2aSThomas Huth     LOG_DIS("or r%d r%d r%d imm=%x\n", dc->rd, dc->ra, dc->rb, dc->imm);
423fcf5ef2aSThomas Huth     if (dc->rd)
424cfeea807SEdgar E. Iglesias         tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
425fcf5ef2aSThomas Huth }
426fcf5ef2aSThomas Huth 
427fcf5ef2aSThomas Huth static void dec_xor(DisasContext *dc)
428fcf5ef2aSThomas Huth {
429fcf5ef2aSThomas Huth     if (!dc->type_b && (dc->imm & (1 << 10))) {
430fcf5ef2aSThomas Huth         dec_pattern(dc);
431fcf5ef2aSThomas Huth         return;
432fcf5ef2aSThomas Huth     }
433fcf5ef2aSThomas Huth 
434fcf5ef2aSThomas Huth     LOG_DIS("xor r%d\n", dc->rd);
435fcf5ef2aSThomas Huth     if (dc->rd)
436cfeea807SEdgar E. Iglesias         tcg_gen_xor_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
437fcf5ef2aSThomas Huth }
438fcf5ef2aSThomas Huth 
439cfeea807SEdgar E. Iglesias static inline void msr_read(DisasContext *dc, TCGv_i32 d)
440fcf5ef2aSThomas Huth {
441cfeea807SEdgar E. Iglesias     tcg_gen_mov_i32(d, cpu_SR[SR_MSR]);
442fcf5ef2aSThomas Huth }
443fcf5ef2aSThomas Huth 
444cfeea807SEdgar E. Iglesias static inline void msr_write(DisasContext *dc, TCGv_i32 v)
445fcf5ef2aSThomas Huth {
446cfeea807SEdgar E. Iglesias     TCGv_i32 t;
447fcf5ef2aSThomas Huth 
448cfeea807SEdgar E. Iglesias     t = tcg_temp_new_i32();
449fcf5ef2aSThomas Huth     dc->cpustate_changed = 1;
450fcf5ef2aSThomas Huth     /* PVR bit is not writable.  */
451cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t, v, ~MSR_PVR);
452cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], MSR_PVR);
453cfeea807SEdgar E. Iglesias     tcg_gen_or_i32(cpu_SR[SR_MSR], cpu_SR[SR_MSR], t);
454fcf5ef2aSThomas Huth     tcg_temp_free(t);
455fcf5ef2aSThomas Huth }
456fcf5ef2aSThomas Huth 
457fcf5ef2aSThomas Huth static void dec_msr(DisasContext *dc)
458fcf5ef2aSThomas Huth {
459fcf5ef2aSThomas Huth     CPUState *cs = CPU(dc->cpu);
460cfeea807SEdgar E. Iglesias     TCGv_i32 t0, t1;
461*2023e9a3SEdgar E. Iglesias     unsigned int sr, rn;
462*2023e9a3SEdgar E. Iglesias     bool to, clrset;
463fcf5ef2aSThomas Huth 
464*2023e9a3SEdgar E. Iglesias     sr = extract32(dc->imm, 0, 14);
465*2023e9a3SEdgar E. Iglesias     to = extract32(dc->imm, 14, 1);
466*2023e9a3SEdgar E. Iglesias     clrset = extract32(dc->imm, 15, 1) == 0;
467fcf5ef2aSThomas Huth     dc->type_b = 1;
468*2023e9a3SEdgar E. Iglesias     if (to) {
469fcf5ef2aSThomas Huth         dc->cpustate_changed = 1;
470*2023e9a3SEdgar E. Iglesias     }
471fcf5ef2aSThomas Huth 
472fcf5ef2aSThomas Huth     /* msrclr and msrset.  */
473*2023e9a3SEdgar E. Iglesias     if (clrset) {
474*2023e9a3SEdgar E. Iglesias         bool clr = extract32(dc->ir, 16, 1);
475fcf5ef2aSThomas Huth 
476fcf5ef2aSThomas Huth         LOG_DIS("msr%s r%d imm=%x\n", clr ? "clr" : "set",
477fcf5ef2aSThomas Huth                 dc->rd, dc->imm);
478fcf5ef2aSThomas Huth 
47956837509SEdgar E. Iglesias         if (!dc->cpu->cfg.use_msr_instr) {
480fcf5ef2aSThomas Huth             /* nop??? */
481fcf5ef2aSThomas Huth             return;
482fcf5ef2aSThomas Huth         }
483fcf5ef2aSThomas Huth 
484bdfc1e88SEdgar E. Iglesias         if (trap_userspace(dc, dc->imm != 4 && dc->imm != 0)) {
485fcf5ef2aSThomas Huth             return;
486fcf5ef2aSThomas Huth         }
487fcf5ef2aSThomas Huth 
488fcf5ef2aSThomas Huth         if (dc->rd)
489fcf5ef2aSThomas Huth             msr_read(dc, cpu_R[dc->rd]);
490fcf5ef2aSThomas Huth 
491cfeea807SEdgar E. Iglesias         t0 = tcg_temp_new_i32();
492cfeea807SEdgar E. Iglesias         t1 = tcg_temp_new_i32();
493fcf5ef2aSThomas Huth         msr_read(dc, t0);
494cfeea807SEdgar E. Iglesias         tcg_gen_mov_i32(t1, *(dec_alu_op_b(dc)));
495fcf5ef2aSThomas Huth 
496fcf5ef2aSThomas Huth         if (clr) {
497cfeea807SEdgar E. Iglesias             tcg_gen_not_i32(t1, t1);
498cfeea807SEdgar E. Iglesias             tcg_gen_and_i32(t0, t0, t1);
499fcf5ef2aSThomas Huth         } else
500cfeea807SEdgar E. Iglesias             tcg_gen_or_i32(t0, t0, t1);
501fcf5ef2aSThomas Huth         msr_write(dc, t0);
502cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(t0);
503cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(t1);
504cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc + 4);
505fcf5ef2aSThomas Huth         dc->is_jmp = DISAS_UPDATE;
506fcf5ef2aSThomas Huth         return;
507fcf5ef2aSThomas Huth     }
508fcf5ef2aSThomas Huth 
509bdfc1e88SEdgar E. Iglesias     if (trap_userspace(dc, to)) {
510fcf5ef2aSThomas Huth         return;
511fcf5ef2aSThomas Huth     }
512fcf5ef2aSThomas Huth 
513fcf5ef2aSThomas Huth #if !defined(CONFIG_USER_ONLY)
514fcf5ef2aSThomas Huth     /* Catch read/writes to the mmu block.  */
515fcf5ef2aSThomas Huth     if ((sr & ~0xff) == 0x1000) {
516fcf5ef2aSThomas Huth         sr &= 7;
517fcf5ef2aSThomas Huth         LOG_DIS("m%ss sr%d r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm);
518fcf5ef2aSThomas Huth         if (to)
519cfeea807SEdgar E. Iglesias             gen_helper_mmu_write(cpu_env, tcg_const_i32(sr), cpu_R[dc->ra]);
520fcf5ef2aSThomas Huth         else
521cfeea807SEdgar E. Iglesias             gen_helper_mmu_read(cpu_R[dc->rd], cpu_env, tcg_const_i32(sr));
522fcf5ef2aSThomas Huth         return;
523fcf5ef2aSThomas Huth     }
524fcf5ef2aSThomas Huth #endif
525fcf5ef2aSThomas Huth 
526fcf5ef2aSThomas Huth     if (to) {
527fcf5ef2aSThomas Huth         LOG_DIS("m%ss sr%x r%d imm=%x\n", to ? "t" : "f", sr, dc->ra, dc->imm);
528fcf5ef2aSThomas Huth         switch (sr) {
529fcf5ef2aSThomas Huth             case 0:
530fcf5ef2aSThomas Huth                 break;
531fcf5ef2aSThomas Huth             case 1:
532fcf5ef2aSThomas Huth                 msr_write(dc, cpu_R[dc->ra]);
533fcf5ef2aSThomas Huth                 break;
534fcf5ef2aSThomas Huth             case 0x3:
535cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_SR[SR_EAR], cpu_R[dc->ra]);
536fcf5ef2aSThomas Huth                 break;
537fcf5ef2aSThomas Huth             case 0x5:
538cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_SR[SR_ESR], cpu_R[dc->ra]);
539fcf5ef2aSThomas Huth                 break;
540fcf5ef2aSThomas Huth             case 0x7:
541cfeea807SEdgar E. Iglesias                 tcg_gen_andi_i32(cpu_SR[SR_FSR], cpu_R[dc->ra], 31);
542fcf5ef2aSThomas Huth                 break;
543fcf5ef2aSThomas Huth             case 0x800:
544cfeea807SEdgar E. Iglesias                 tcg_gen_st_i32(cpu_R[dc->ra],
545cfeea807SEdgar E. Iglesias                                cpu_env, offsetof(CPUMBState, slr));
546fcf5ef2aSThomas Huth                 break;
547fcf5ef2aSThomas Huth             case 0x802:
548cfeea807SEdgar E. Iglesias                 tcg_gen_st_i32(cpu_R[dc->ra],
549cfeea807SEdgar E. Iglesias                                cpu_env, offsetof(CPUMBState, shr));
550fcf5ef2aSThomas Huth                 break;
551fcf5ef2aSThomas Huth             default:
552fcf5ef2aSThomas Huth                 cpu_abort(CPU(dc->cpu), "unknown mts reg %x\n", sr);
553fcf5ef2aSThomas Huth                 break;
554fcf5ef2aSThomas Huth         }
555fcf5ef2aSThomas Huth     } else {
556fcf5ef2aSThomas Huth         LOG_DIS("m%ss r%d sr%x imm=%x\n", to ? "t" : "f", dc->rd, sr, dc->imm);
557fcf5ef2aSThomas Huth 
558fcf5ef2aSThomas Huth         switch (sr) {
559fcf5ef2aSThomas Huth             case 0:
560cfeea807SEdgar E. Iglesias                 tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc);
561fcf5ef2aSThomas Huth                 break;
562fcf5ef2aSThomas Huth             case 1:
563fcf5ef2aSThomas Huth                 msr_read(dc, cpu_R[dc->rd]);
564fcf5ef2aSThomas Huth                 break;
565fcf5ef2aSThomas Huth             case 0x3:
566cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_EAR]);
567fcf5ef2aSThomas Huth                 break;
568fcf5ef2aSThomas Huth             case 0x5:
569cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_ESR]);
570fcf5ef2aSThomas Huth                 break;
571fcf5ef2aSThomas Huth              case 0x7:
572cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_FSR]);
573fcf5ef2aSThomas Huth                 break;
574fcf5ef2aSThomas Huth             case 0xb:
575cfeea807SEdgar E. Iglesias                 tcg_gen_mov_i32(cpu_R[dc->rd], cpu_SR[SR_BTR]);
576fcf5ef2aSThomas Huth                 break;
577fcf5ef2aSThomas Huth             case 0x800:
578cfeea807SEdgar E. Iglesias                 tcg_gen_ld_i32(cpu_R[dc->rd],
579cfeea807SEdgar E. Iglesias                                cpu_env, offsetof(CPUMBState, slr));
580fcf5ef2aSThomas Huth                 break;
581fcf5ef2aSThomas Huth             case 0x802:
582cfeea807SEdgar E. Iglesias                 tcg_gen_ld_i32(cpu_R[dc->rd],
583cfeea807SEdgar E. Iglesias                                cpu_env, offsetof(CPUMBState, shr));
584fcf5ef2aSThomas Huth                 break;
585fcf5ef2aSThomas Huth             case 0x2000:
586fcf5ef2aSThomas Huth             case 0x2001:
587fcf5ef2aSThomas Huth             case 0x2002:
588fcf5ef2aSThomas Huth             case 0x2003:
589fcf5ef2aSThomas Huth             case 0x2004:
590fcf5ef2aSThomas Huth             case 0x2005:
591fcf5ef2aSThomas Huth             case 0x2006:
592fcf5ef2aSThomas Huth             case 0x2007:
593fcf5ef2aSThomas Huth             case 0x2008:
594fcf5ef2aSThomas Huth             case 0x2009:
595fcf5ef2aSThomas Huth             case 0x200a:
596fcf5ef2aSThomas Huth             case 0x200b:
597fcf5ef2aSThomas Huth             case 0x200c:
598fcf5ef2aSThomas Huth                 rn = sr & 0xf;
599cfeea807SEdgar E. Iglesias                 tcg_gen_ld_i32(cpu_R[dc->rd],
600fcf5ef2aSThomas Huth                               cpu_env, offsetof(CPUMBState, pvr.regs[rn]));
601fcf5ef2aSThomas Huth                 break;
602fcf5ef2aSThomas Huth             default:
603fcf5ef2aSThomas Huth                 cpu_abort(cs, "unknown mfs reg %x\n", sr);
604fcf5ef2aSThomas Huth                 break;
605fcf5ef2aSThomas Huth         }
606fcf5ef2aSThomas Huth     }
607fcf5ef2aSThomas Huth 
608fcf5ef2aSThomas Huth     if (dc->rd == 0) {
609cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_R[0], 0);
610fcf5ef2aSThomas Huth     }
611fcf5ef2aSThomas Huth }
612fcf5ef2aSThomas Huth 
613fcf5ef2aSThomas Huth /* Multiplier unit.  */
614fcf5ef2aSThomas Huth static void dec_mul(DisasContext *dc)
615fcf5ef2aSThomas Huth {
616cfeea807SEdgar E. Iglesias     TCGv_i32 tmp;
617fcf5ef2aSThomas Huth     unsigned int subcode;
618fcf5ef2aSThomas Huth 
6199ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, !dc->cpu->cfg.use_hw_mul)) {
620fcf5ef2aSThomas Huth         return;
621fcf5ef2aSThomas Huth     }
622fcf5ef2aSThomas Huth 
623fcf5ef2aSThomas Huth     subcode = dc->imm & 3;
624fcf5ef2aSThomas Huth 
625fcf5ef2aSThomas Huth     if (dc->type_b) {
626fcf5ef2aSThomas Huth         LOG_DIS("muli r%d r%d %x\n", dc->rd, dc->ra, dc->imm);
627cfeea807SEdgar E. Iglesias         tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], *(dec_alu_op_b(dc)));
628fcf5ef2aSThomas Huth         return;
629fcf5ef2aSThomas Huth     }
630fcf5ef2aSThomas Huth 
631fcf5ef2aSThomas Huth     /* mulh, mulhsu and mulhu are not available if C_USE_HW_MUL is < 2.  */
6329b964318SEdgar E. Iglesias     if (subcode >= 1 && subcode <= 3 && dc->cpu->cfg.use_hw_mul < 2) {
633fcf5ef2aSThomas Huth         /* nop??? */
634fcf5ef2aSThomas Huth     }
635fcf5ef2aSThomas Huth 
636cfeea807SEdgar E. Iglesias     tmp = tcg_temp_new_i32();
637fcf5ef2aSThomas Huth     switch (subcode) {
638fcf5ef2aSThomas Huth         case 0:
639fcf5ef2aSThomas Huth             LOG_DIS("mul r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
640cfeea807SEdgar E. Iglesias             tcg_gen_mul_i32(cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
641fcf5ef2aSThomas Huth             break;
642fcf5ef2aSThomas Huth         case 1:
643fcf5ef2aSThomas Huth             LOG_DIS("mulh r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
644cfeea807SEdgar E. Iglesias             tcg_gen_muls2_i32(tmp, cpu_R[dc->rd],
645cfeea807SEdgar E. Iglesias                               cpu_R[dc->ra], cpu_R[dc->rb]);
646fcf5ef2aSThomas Huth             break;
647fcf5ef2aSThomas Huth         case 2:
648fcf5ef2aSThomas Huth             LOG_DIS("mulhsu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
649cfeea807SEdgar E. Iglesias             tcg_gen_mulsu2_i32(tmp, cpu_R[dc->rd],
650cfeea807SEdgar E. Iglesias                                cpu_R[dc->ra], cpu_R[dc->rb]);
651fcf5ef2aSThomas Huth             break;
652fcf5ef2aSThomas Huth         case 3:
653fcf5ef2aSThomas Huth             LOG_DIS("mulhu r%d r%d r%d\n", dc->rd, dc->ra, dc->rb);
654cfeea807SEdgar E. Iglesias             tcg_gen_mulu2_i32(tmp, cpu_R[dc->rd], cpu_R[dc->ra], cpu_R[dc->rb]);
655fcf5ef2aSThomas Huth             break;
656fcf5ef2aSThomas Huth         default:
657fcf5ef2aSThomas Huth             cpu_abort(CPU(dc->cpu), "unknown MUL insn %x\n", subcode);
658fcf5ef2aSThomas Huth             break;
659fcf5ef2aSThomas Huth     }
660cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(tmp);
661fcf5ef2aSThomas Huth }
662fcf5ef2aSThomas Huth 
663fcf5ef2aSThomas Huth /* Div unit.  */
664fcf5ef2aSThomas Huth static void dec_div(DisasContext *dc)
665fcf5ef2aSThomas Huth {
666fcf5ef2aSThomas Huth     unsigned int u;
667fcf5ef2aSThomas Huth 
668fcf5ef2aSThomas Huth     u = dc->imm & 2;
669fcf5ef2aSThomas Huth     LOG_DIS("div\n");
670fcf5ef2aSThomas Huth 
6719ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, !dc->cpu->cfg.use_div)) {
6729ba8cd45SEdgar E. Iglesias         return;
673fcf5ef2aSThomas Huth     }
674fcf5ef2aSThomas Huth 
675fcf5ef2aSThomas Huth     if (u)
676fcf5ef2aSThomas Huth         gen_helper_divu(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)),
677fcf5ef2aSThomas Huth                         cpu_R[dc->ra]);
678fcf5ef2aSThomas Huth     else
679fcf5ef2aSThomas Huth         gen_helper_divs(cpu_R[dc->rd], cpu_env, *(dec_alu_op_b(dc)),
680fcf5ef2aSThomas Huth                         cpu_R[dc->ra]);
681fcf5ef2aSThomas Huth     if (!dc->rd)
682cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_R[dc->rd], 0);
683fcf5ef2aSThomas Huth }
684fcf5ef2aSThomas Huth 
685fcf5ef2aSThomas Huth static void dec_barrel(DisasContext *dc)
686fcf5ef2aSThomas Huth {
687cfeea807SEdgar E. Iglesias     TCGv_i32 t0;
688faa48d74SEdgar E. Iglesias     unsigned int imm_w, imm_s;
689d09b2585SEdgar E. Iglesias     bool s, t, e = false, i = false;
690fcf5ef2aSThomas Huth 
6919ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, !dc->cpu->cfg.use_barrel)) {
692fcf5ef2aSThomas Huth         return;
693fcf5ef2aSThomas Huth     }
694fcf5ef2aSThomas Huth 
695faa48d74SEdgar E. Iglesias     if (dc->type_b) {
696faa48d74SEdgar E. Iglesias         /* Insert and extract are only available in immediate mode.  */
697d09b2585SEdgar E. Iglesias         i = extract32(dc->imm, 15, 1);
698faa48d74SEdgar E. Iglesias         e = extract32(dc->imm, 14, 1);
699faa48d74SEdgar E. Iglesias     }
700e3e84983SEdgar E. Iglesias     s = extract32(dc->imm, 10, 1);
701e3e84983SEdgar E. Iglesias     t = extract32(dc->imm, 9, 1);
702faa48d74SEdgar E. Iglesias     imm_w = extract32(dc->imm, 6, 5);
703faa48d74SEdgar E. Iglesias     imm_s = extract32(dc->imm, 0, 5);
704fcf5ef2aSThomas Huth 
705faa48d74SEdgar E. Iglesias     LOG_DIS("bs%s%s%s r%d r%d r%d\n",
706faa48d74SEdgar E. Iglesias             e ? "e" : "",
707fcf5ef2aSThomas Huth             s ? "l" : "r", t ? "a" : "l", dc->rd, dc->ra, dc->rb);
708fcf5ef2aSThomas Huth 
709faa48d74SEdgar E. Iglesias     if (e) {
710faa48d74SEdgar E. Iglesias         if (imm_w + imm_s > 32 || imm_w == 0) {
711faa48d74SEdgar E. Iglesias             /* These inputs have an undefined behavior.  */
712faa48d74SEdgar E. Iglesias             qemu_log_mask(LOG_GUEST_ERROR, "bsefi: Bad input w=%d s=%d\n",
713faa48d74SEdgar E. Iglesias                           imm_w, imm_s);
714faa48d74SEdgar E. Iglesias         } else {
715faa48d74SEdgar E. Iglesias             tcg_gen_extract_i32(cpu_R[dc->rd], cpu_R[dc->ra], imm_s, imm_w);
716faa48d74SEdgar E. Iglesias         }
717d09b2585SEdgar E. Iglesias     } else if (i) {
718d09b2585SEdgar E. Iglesias         int width = imm_w - imm_s + 1;
719d09b2585SEdgar E. Iglesias 
720d09b2585SEdgar E. Iglesias         if (imm_w < imm_s) {
721d09b2585SEdgar E. Iglesias             /* These inputs have an undefined behavior.  */
722d09b2585SEdgar E. Iglesias             qemu_log_mask(LOG_GUEST_ERROR, "bsifi: Bad input w=%d s=%d\n",
723d09b2585SEdgar E. Iglesias                           imm_w, imm_s);
724d09b2585SEdgar E. Iglesias         } else {
725d09b2585SEdgar E. Iglesias             tcg_gen_deposit_i32(cpu_R[dc->rd], cpu_R[dc->rd], cpu_R[dc->ra],
726d09b2585SEdgar E. Iglesias                                 imm_s, width);
727d09b2585SEdgar E. Iglesias         }
728faa48d74SEdgar E. Iglesias     } else {
729cfeea807SEdgar E. Iglesias         t0 = tcg_temp_new_i32();
730fcf5ef2aSThomas Huth 
731cfeea807SEdgar E. Iglesias         tcg_gen_mov_i32(t0, *(dec_alu_op_b(dc)));
732cfeea807SEdgar E. Iglesias         tcg_gen_andi_i32(t0, t0, 31);
733fcf5ef2aSThomas Huth 
7342acf6d53SEdgar E. Iglesias         if (s) {
735cfeea807SEdgar E. Iglesias             tcg_gen_shl_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0);
7362acf6d53SEdgar E. Iglesias         } else {
7372acf6d53SEdgar E. Iglesias             if (t) {
738cfeea807SEdgar E. Iglesias                 tcg_gen_sar_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0);
7392acf6d53SEdgar E. Iglesias             } else {
740cfeea807SEdgar E. Iglesias                 tcg_gen_shr_i32(cpu_R[dc->rd], cpu_R[dc->ra], t0);
741fcf5ef2aSThomas Huth             }
742fcf5ef2aSThomas Huth         }
743cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(t0);
7442acf6d53SEdgar E. Iglesias     }
745faa48d74SEdgar E. Iglesias }
746fcf5ef2aSThomas Huth 
747fcf5ef2aSThomas Huth static void dec_bit(DisasContext *dc)
748fcf5ef2aSThomas Huth {
749fcf5ef2aSThomas Huth     CPUState *cs = CPU(dc->cpu);
750cfeea807SEdgar E. Iglesias     TCGv_i32 t0;
751fcf5ef2aSThomas Huth     unsigned int op;
752fcf5ef2aSThomas Huth 
753fcf5ef2aSThomas Huth     op = dc->ir & ((1 << 9) - 1);
754fcf5ef2aSThomas Huth     switch (op) {
755fcf5ef2aSThomas Huth         case 0x21:
756fcf5ef2aSThomas Huth             /* src.  */
757cfeea807SEdgar E. Iglesias             t0 = tcg_temp_new_i32();
758fcf5ef2aSThomas Huth 
759fcf5ef2aSThomas Huth             LOG_DIS("src r%d r%d\n", dc->rd, dc->ra);
760cfeea807SEdgar E. Iglesias             tcg_gen_andi_i32(t0, cpu_SR[SR_MSR], MSR_CC);
761fcf5ef2aSThomas Huth             write_carry(dc, cpu_R[dc->ra]);
762fcf5ef2aSThomas Huth             if (dc->rd) {
763cfeea807SEdgar E. Iglesias                 tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1);
764cfeea807SEdgar E. Iglesias                 tcg_gen_or_i32(cpu_R[dc->rd], cpu_R[dc->rd], t0);
765fcf5ef2aSThomas Huth             }
766cfeea807SEdgar E. Iglesias             tcg_temp_free_i32(t0);
767fcf5ef2aSThomas Huth             break;
768fcf5ef2aSThomas Huth 
769fcf5ef2aSThomas Huth         case 0x1:
770fcf5ef2aSThomas Huth         case 0x41:
771fcf5ef2aSThomas Huth             /* srl.  */
772fcf5ef2aSThomas Huth             LOG_DIS("srl r%d r%d\n", dc->rd, dc->ra);
773fcf5ef2aSThomas Huth 
774fcf5ef2aSThomas Huth             /* Update carry. Note that write carry only looks at the LSB.  */
775fcf5ef2aSThomas Huth             write_carry(dc, cpu_R[dc->ra]);
776fcf5ef2aSThomas Huth             if (dc->rd) {
777fcf5ef2aSThomas Huth                 if (op == 0x41)
778cfeea807SEdgar E. Iglesias                     tcg_gen_shri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1);
779fcf5ef2aSThomas Huth                 else
780cfeea807SEdgar E. Iglesias                     tcg_gen_sari_i32(cpu_R[dc->rd], cpu_R[dc->ra], 1);
781fcf5ef2aSThomas Huth             }
782fcf5ef2aSThomas Huth             break;
783fcf5ef2aSThomas Huth         case 0x60:
784fcf5ef2aSThomas Huth             LOG_DIS("ext8s r%d r%d\n", dc->rd, dc->ra);
785fcf5ef2aSThomas Huth             tcg_gen_ext8s_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
786fcf5ef2aSThomas Huth             break;
787fcf5ef2aSThomas Huth         case 0x61:
788fcf5ef2aSThomas Huth             LOG_DIS("ext16s r%d r%d\n", dc->rd, dc->ra);
789fcf5ef2aSThomas Huth             tcg_gen_ext16s_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
790fcf5ef2aSThomas Huth             break;
791fcf5ef2aSThomas Huth         case 0x64:
792fcf5ef2aSThomas Huth         case 0x66:
793fcf5ef2aSThomas Huth         case 0x74:
794fcf5ef2aSThomas Huth         case 0x76:
795fcf5ef2aSThomas Huth             /* wdc.  */
796fcf5ef2aSThomas Huth             LOG_DIS("wdc r%d\n", dc->ra);
797bdfc1e88SEdgar E. Iglesias             trap_userspace(dc, true);
798fcf5ef2aSThomas Huth             break;
799fcf5ef2aSThomas Huth         case 0x68:
800fcf5ef2aSThomas Huth             /* wic.  */
801fcf5ef2aSThomas Huth             LOG_DIS("wic r%d\n", dc->ra);
802bdfc1e88SEdgar E. Iglesias             trap_userspace(dc, true);
803fcf5ef2aSThomas Huth             break;
804fcf5ef2aSThomas Huth         case 0xe0:
8059ba8cd45SEdgar E. Iglesias             if (trap_illegal(dc, !dc->cpu->cfg.use_pcmp_instr)) {
8069ba8cd45SEdgar E. Iglesias                 return;
807fcf5ef2aSThomas Huth             }
8088fc5239eSEdgar E. Iglesias             if (dc->cpu->cfg.use_pcmp_instr) {
8095318420cSRichard Henderson                 tcg_gen_clzi_i32(cpu_R[dc->rd], cpu_R[dc->ra], 32);
810fcf5ef2aSThomas Huth             }
811fcf5ef2aSThomas Huth             break;
812fcf5ef2aSThomas Huth         case 0x1e0:
813fcf5ef2aSThomas Huth             /* swapb */
814fcf5ef2aSThomas Huth             LOG_DIS("swapb r%d r%d\n", dc->rd, dc->ra);
815fcf5ef2aSThomas Huth             tcg_gen_bswap32_i32(cpu_R[dc->rd], cpu_R[dc->ra]);
816fcf5ef2aSThomas Huth             break;
817fcf5ef2aSThomas Huth         case 0x1e2:
818fcf5ef2aSThomas Huth             /*swaph */
819fcf5ef2aSThomas Huth             LOG_DIS("swaph r%d r%d\n", dc->rd, dc->ra);
820fcf5ef2aSThomas Huth             tcg_gen_rotri_i32(cpu_R[dc->rd], cpu_R[dc->ra], 16);
821fcf5ef2aSThomas Huth             break;
822fcf5ef2aSThomas Huth         default:
823fcf5ef2aSThomas Huth             cpu_abort(cs, "unknown bit oc=%x op=%x rd=%d ra=%d rb=%d\n",
824fcf5ef2aSThomas Huth                       dc->pc, op, dc->rd, dc->ra, dc->rb);
825fcf5ef2aSThomas Huth             break;
826fcf5ef2aSThomas Huth     }
827fcf5ef2aSThomas Huth }
828fcf5ef2aSThomas Huth 
829fcf5ef2aSThomas Huth static inline void sync_jmpstate(DisasContext *dc)
830fcf5ef2aSThomas Huth {
831fcf5ef2aSThomas Huth     if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) {
832fcf5ef2aSThomas Huth         if (dc->jmp == JMP_DIRECT) {
833cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(env_btaken, 1);
834fcf5ef2aSThomas Huth         }
835fcf5ef2aSThomas Huth         dc->jmp = JMP_INDIRECT;
836cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(env_btarget, dc->jmp_pc);
837fcf5ef2aSThomas Huth     }
838fcf5ef2aSThomas Huth }
839fcf5ef2aSThomas Huth 
840fcf5ef2aSThomas Huth static void dec_imm(DisasContext *dc)
841fcf5ef2aSThomas Huth {
842fcf5ef2aSThomas Huth     LOG_DIS("imm %x\n", dc->imm << 16);
843cfeea807SEdgar E. Iglesias     tcg_gen_movi_i32(env_imm, (dc->imm << 16));
844fcf5ef2aSThomas Huth     dc->tb_flags |= IMM_FLAG;
845fcf5ef2aSThomas Huth     dc->clear_imm = 0;
846fcf5ef2aSThomas Huth }
847fcf5ef2aSThomas Huth 
848403322eaSEdgar E. Iglesias static inline void compute_ldst_addr(DisasContext *dc, TCGv t)
849fcf5ef2aSThomas Huth {
8500e9033c8SEdgar E. Iglesias     bool extimm = dc->tb_flags & IMM_FLAG;
8510e9033c8SEdgar E. Iglesias     /* Should be set to true if r1 is used by loadstores.  */
8520e9033c8SEdgar E. Iglesias     bool stackprot = false;
853403322eaSEdgar E. Iglesias     TCGv_i32 t32;
854fcf5ef2aSThomas Huth 
855fcf5ef2aSThomas Huth     /* All load/stores use ra.  */
856fcf5ef2aSThomas Huth     if (dc->ra == 1 && dc->cpu->cfg.stackprot) {
8570e9033c8SEdgar E. Iglesias         stackprot = true;
858fcf5ef2aSThomas Huth     }
859fcf5ef2aSThomas Huth 
860fcf5ef2aSThomas Huth     /* Treat the common cases first.  */
861fcf5ef2aSThomas Huth     if (!dc->type_b) {
8620dc4af5cSEdgar E. Iglesias         /* If any of the regs is r0, set t to the value of the other reg.  */
863fcf5ef2aSThomas Huth         if (dc->ra == 0) {
864403322eaSEdgar E. Iglesias             tcg_gen_extu_i32_tl(t, cpu_R[dc->rb]);
8650dc4af5cSEdgar E. Iglesias             return;
866fcf5ef2aSThomas Huth         } else if (dc->rb == 0) {
867403322eaSEdgar E. Iglesias             tcg_gen_extu_i32_tl(t, cpu_R[dc->ra]);
8680dc4af5cSEdgar E. Iglesias             return;
869fcf5ef2aSThomas Huth         }
870fcf5ef2aSThomas Huth 
871fcf5ef2aSThomas Huth         if (dc->rb == 1 && dc->cpu->cfg.stackprot) {
8720e9033c8SEdgar E. Iglesias             stackprot = true;
873fcf5ef2aSThomas Huth         }
874fcf5ef2aSThomas Huth 
875403322eaSEdgar E. Iglesias         t32 = tcg_temp_new_i32();
876403322eaSEdgar E. Iglesias         tcg_gen_add_i32(t32, cpu_R[dc->ra], cpu_R[dc->rb]);
877403322eaSEdgar E. Iglesias         tcg_gen_extu_i32_tl(t, t32);
878403322eaSEdgar E. Iglesias         tcg_temp_free_i32(t32);
879fcf5ef2aSThomas Huth 
880fcf5ef2aSThomas Huth         if (stackprot) {
8810a87e691SEdgar E. Iglesias             gen_helper_stackprot(cpu_env, t);
882fcf5ef2aSThomas Huth         }
8830dc4af5cSEdgar E. Iglesias         return;
884fcf5ef2aSThomas Huth     }
885fcf5ef2aSThomas Huth     /* Immediate.  */
886403322eaSEdgar E. Iglesias     t32 = tcg_temp_new_i32();
887fcf5ef2aSThomas Huth     if (!extimm) {
888fcf5ef2aSThomas Huth         if (dc->imm == 0) {
889403322eaSEdgar E. Iglesias             tcg_gen_mov_i32(t32, cpu_R[dc->ra]);
890fcf5ef2aSThomas Huth         } else {
891403322eaSEdgar E. Iglesias             tcg_gen_movi_i32(t32, (int32_t)((int16_t)dc->imm));
892403322eaSEdgar E. Iglesias             tcg_gen_add_i32(t32, cpu_R[dc->ra], t32);
893fcf5ef2aSThomas Huth         }
894403322eaSEdgar E. Iglesias     } else {
895403322eaSEdgar E. Iglesias         tcg_gen_add_i32(t32, cpu_R[dc->ra], *(dec_alu_op_b(dc)));
896403322eaSEdgar E. Iglesias     }
897403322eaSEdgar E. Iglesias     tcg_gen_extu_i32_tl(t, t32);
898403322eaSEdgar E. Iglesias     tcg_temp_free_i32(t32);
899fcf5ef2aSThomas Huth 
900fcf5ef2aSThomas Huth     if (stackprot) {
9010a87e691SEdgar E. Iglesias         gen_helper_stackprot(cpu_env, t);
902fcf5ef2aSThomas Huth     }
9030dc4af5cSEdgar E. Iglesias     return;
904fcf5ef2aSThomas Huth }
905fcf5ef2aSThomas Huth 
906fcf5ef2aSThomas Huth static void dec_load(DisasContext *dc)
907fcf5ef2aSThomas Huth {
908403322eaSEdgar E. Iglesias     TCGv_i32 v;
909403322eaSEdgar E. Iglesias     TCGv addr;
9108534063aSEdgar E. Iglesias     unsigned int size;
9118534063aSEdgar E. Iglesias     bool rev = false, ex = false;
912fcf5ef2aSThomas Huth     TCGMemOp mop;
913fcf5ef2aSThomas Huth 
914fcf5ef2aSThomas Huth     mop = dc->opcode & 3;
915fcf5ef2aSThomas Huth     size = 1 << mop;
916fcf5ef2aSThomas Huth     if (!dc->type_b) {
9178534063aSEdgar E. Iglesias         rev = extract32(dc->ir, 9, 1);
9188534063aSEdgar E. Iglesias         ex = extract32(dc->ir, 10, 1);
919fcf5ef2aSThomas Huth     }
920fcf5ef2aSThomas Huth     mop |= MO_TE;
921fcf5ef2aSThomas Huth     if (rev) {
922fcf5ef2aSThomas Huth         mop ^= MO_BSWAP;
923fcf5ef2aSThomas Huth     }
924fcf5ef2aSThomas Huth 
9259ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, size > 4)) {
926fcf5ef2aSThomas Huth         return;
927fcf5ef2aSThomas Huth     }
928fcf5ef2aSThomas Huth 
929fcf5ef2aSThomas Huth     LOG_DIS("l%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "",
930fcf5ef2aSThomas Huth                                                         ex ? "x" : "");
931fcf5ef2aSThomas Huth 
932fcf5ef2aSThomas Huth     t_sync_flags(dc);
933403322eaSEdgar E. Iglesias     addr = tcg_temp_new();
9340a87e691SEdgar E. Iglesias     compute_ldst_addr(dc, addr);
935fcf5ef2aSThomas Huth 
936fcf5ef2aSThomas Huth     /*
937fcf5ef2aSThomas Huth      * When doing reverse accesses we need to do two things.
938fcf5ef2aSThomas Huth      *
939fcf5ef2aSThomas Huth      * 1. Reverse the address wrt endianness.
940fcf5ef2aSThomas Huth      * 2. Byteswap the data lanes on the way back into the CPU core.
941fcf5ef2aSThomas Huth      */
942fcf5ef2aSThomas Huth     if (rev && size != 4) {
943fcf5ef2aSThomas Huth         /* Endian reverse the address. t is addr.  */
944fcf5ef2aSThomas Huth         switch (size) {
945fcf5ef2aSThomas Huth             case 1:
946fcf5ef2aSThomas Huth             {
947fcf5ef2aSThomas Huth                 /* 00 -> 11
948fcf5ef2aSThomas Huth                    01 -> 10
949fcf5ef2aSThomas Huth                    10 -> 10
950fcf5ef2aSThomas Huth                    11 -> 00 */
951403322eaSEdgar E. Iglesias                 TCGv low = tcg_temp_new();
952fcf5ef2aSThomas Huth 
953403322eaSEdgar E. Iglesias                 tcg_gen_andi_tl(low, addr, 3);
954403322eaSEdgar E. Iglesias                 tcg_gen_sub_tl(low, tcg_const_tl(3), low);
955403322eaSEdgar E. Iglesias                 tcg_gen_andi_tl(addr, addr, ~3);
956403322eaSEdgar E. Iglesias                 tcg_gen_or_tl(addr, addr, low);
957403322eaSEdgar E. Iglesias                 tcg_temp_free(low);
958fcf5ef2aSThomas Huth                 break;
959fcf5ef2aSThomas Huth             }
960fcf5ef2aSThomas Huth 
961fcf5ef2aSThomas Huth             case 2:
962fcf5ef2aSThomas Huth                 /* 00 -> 10
963fcf5ef2aSThomas Huth                    10 -> 00.  */
964403322eaSEdgar E. Iglesias                 tcg_gen_xori_tl(addr, addr, 2);
965fcf5ef2aSThomas Huth                 break;
966fcf5ef2aSThomas Huth             default:
967fcf5ef2aSThomas Huth                 cpu_abort(CPU(dc->cpu), "Invalid reverse size\n");
968fcf5ef2aSThomas Huth                 break;
969fcf5ef2aSThomas Huth         }
970fcf5ef2aSThomas Huth     }
971fcf5ef2aSThomas Huth 
972fcf5ef2aSThomas Huth     /* lwx does not throw unaligned access errors, so force alignment */
973fcf5ef2aSThomas Huth     if (ex) {
974403322eaSEdgar E. Iglesias         tcg_gen_andi_tl(addr, addr, ~3);
975fcf5ef2aSThomas Huth     }
976fcf5ef2aSThomas Huth 
977fcf5ef2aSThomas Huth     /* If we get a fault on a dslot, the jmpstate better be in sync.  */
978fcf5ef2aSThomas Huth     sync_jmpstate(dc);
979fcf5ef2aSThomas Huth 
980fcf5ef2aSThomas Huth     /* Verify alignment if needed.  */
981fcf5ef2aSThomas Huth     /*
982fcf5ef2aSThomas Huth      * Microblaze gives MMU faults priority over faults due to
983fcf5ef2aSThomas Huth      * unaligned addresses. That's why we speculatively do the load
984fcf5ef2aSThomas Huth      * into v. If the load succeeds, we verify alignment of the
985fcf5ef2aSThomas Huth      * address and if that succeeds we write into the destination reg.
986fcf5ef2aSThomas Huth      */
987cfeea807SEdgar E. Iglesias     v = tcg_temp_new_i32();
9880dc4af5cSEdgar E. Iglesias     tcg_gen_qemu_ld_i32(v, addr, cpu_mmu_index(&dc->cpu->env, false), mop);
989fcf5ef2aSThomas Huth 
990fcf5ef2aSThomas Huth     if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) {
991cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc);
9920dc4af5cSEdgar E. Iglesias         gen_helper_memalign(cpu_env, addr, tcg_const_i32(dc->rd),
993cfeea807SEdgar E. Iglesias                             tcg_const_i32(0), tcg_const_i32(size - 1));
994fcf5ef2aSThomas Huth     }
995fcf5ef2aSThomas Huth 
996fcf5ef2aSThomas Huth     if (ex) {
997403322eaSEdgar E. Iglesias         tcg_gen_mov_tl(env_res_addr, addr);
998cfeea807SEdgar E. Iglesias         tcg_gen_mov_i32(env_res_val, v);
999fcf5ef2aSThomas Huth     }
1000fcf5ef2aSThomas Huth     if (dc->rd) {
1001cfeea807SEdgar E. Iglesias         tcg_gen_mov_i32(cpu_R[dc->rd], v);
1002fcf5ef2aSThomas Huth     }
1003cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(v);
1004fcf5ef2aSThomas Huth 
1005fcf5ef2aSThomas Huth     if (ex) { /* lwx */
1006fcf5ef2aSThomas Huth         /* no support for AXI exclusive so always clear C */
1007fcf5ef2aSThomas Huth         write_carryi(dc, 0);
1008fcf5ef2aSThomas Huth     }
1009fcf5ef2aSThomas Huth 
1010403322eaSEdgar E. Iglesias     tcg_temp_free(addr);
1011fcf5ef2aSThomas Huth }
1012fcf5ef2aSThomas Huth 
1013fcf5ef2aSThomas Huth static void dec_store(DisasContext *dc)
1014fcf5ef2aSThomas Huth {
1015403322eaSEdgar E. Iglesias     TCGv addr;
1016fcf5ef2aSThomas Huth     TCGLabel *swx_skip = NULL;
1017b51b3d43SEdgar E. Iglesias     unsigned int size;
1018b51b3d43SEdgar E. Iglesias     bool rev = false, ex = false;
1019fcf5ef2aSThomas Huth     TCGMemOp mop;
1020fcf5ef2aSThomas Huth 
1021fcf5ef2aSThomas Huth     mop = dc->opcode & 3;
1022fcf5ef2aSThomas Huth     size = 1 << mop;
1023fcf5ef2aSThomas Huth     if (!dc->type_b) {
1024b51b3d43SEdgar E. Iglesias         rev = extract32(dc->ir, 9, 1);
1025b51b3d43SEdgar E. Iglesias         ex = extract32(dc->ir, 10, 1);
1026fcf5ef2aSThomas Huth     }
1027fcf5ef2aSThomas Huth     mop |= MO_TE;
1028fcf5ef2aSThomas Huth     if (rev) {
1029fcf5ef2aSThomas Huth         mop ^= MO_BSWAP;
1030fcf5ef2aSThomas Huth     }
1031fcf5ef2aSThomas Huth 
10329ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, size > 4)) {
1033fcf5ef2aSThomas Huth         return;
1034fcf5ef2aSThomas Huth     }
1035fcf5ef2aSThomas Huth 
1036fcf5ef2aSThomas Huth     LOG_DIS("s%d%s%s%s\n", size, dc->type_b ? "i" : "", rev ? "r" : "",
1037fcf5ef2aSThomas Huth                                                         ex ? "x" : "");
1038fcf5ef2aSThomas Huth     t_sync_flags(dc);
1039fcf5ef2aSThomas Huth     /* If we get a fault on a dslot, the jmpstate better be in sync.  */
1040fcf5ef2aSThomas Huth     sync_jmpstate(dc);
10410dc4af5cSEdgar E. Iglesias     /* SWX needs a temp_local.  */
1042403322eaSEdgar E. Iglesias     addr = ex ? tcg_temp_local_new() : tcg_temp_new();
10430a87e691SEdgar E. Iglesias     compute_ldst_addr(dc, addr);
1044fcf5ef2aSThomas Huth 
1045fcf5ef2aSThomas Huth     if (ex) { /* swx */
1046cfeea807SEdgar E. Iglesias         TCGv_i32 tval;
1047fcf5ef2aSThomas Huth 
1048fcf5ef2aSThomas Huth         /* swx does not throw unaligned access errors, so force alignment */
1049403322eaSEdgar E. Iglesias         tcg_gen_andi_tl(addr, addr, ~3);
1050fcf5ef2aSThomas Huth 
1051fcf5ef2aSThomas Huth         write_carryi(dc, 1);
1052fcf5ef2aSThomas Huth         swx_skip = gen_new_label();
1053403322eaSEdgar E. Iglesias         tcg_gen_brcond_tl(TCG_COND_NE, env_res_addr, addr, swx_skip);
1054fcf5ef2aSThomas Huth 
1055fcf5ef2aSThomas Huth         /* Compare the value loaded at lwx with current contents of
1056fcf5ef2aSThomas Huth            the reserved location.
1057fcf5ef2aSThomas Huth            FIXME: This only works for system emulation where we can expect
1058fcf5ef2aSThomas Huth            this compare and the following write to be atomic. For user
1059fcf5ef2aSThomas Huth            emulation we need to add atomicity between threads.  */
1060cfeea807SEdgar E. Iglesias         tval = tcg_temp_new_i32();
10610dc4af5cSEdgar E. Iglesias         tcg_gen_qemu_ld_i32(tval, addr, cpu_mmu_index(&dc->cpu->env, false),
1062fcf5ef2aSThomas Huth                             MO_TEUL);
1063cfeea807SEdgar E. Iglesias         tcg_gen_brcond_i32(TCG_COND_NE, env_res_val, tval, swx_skip);
1064fcf5ef2aSThomas Huth         write_carryi(dc, 0);
1065cfeea807SEdgar E. Iglesias         tcg_temp_free_i32(tval);
1066fcf5ef2aSThomas Huth     }
1067fcf5ef2aSThomas Huth 
1068fcf5ef2aSThomas Huth     if (rev && size != 4) {
1069fcf5ef2aSThomas Huth         /* Endian reverse the address. t is addr.  */
1070fcf5ef2aSThomas Huth         switch (size) {
1071fcf5ef2aSThomas Huth             case 1:
1072fcf5ef2aSThomas Huth             {
1073fcf5ef2aSThomas Huth                 /* 00 -> 11
1074fcf5ef2aSThomas Huth                    01 -> 10
1075fcf5ef2aSThomas Huth                    10 -> 10
1076fcf5ef2aSThomas Huth                    11 -> 00 */
1077403322eaSEdgar E. Iglesias                 TCGv low = tcg_temp_new();
1078fcf5ef2aSThomas Huth 
1079403322eaSEdgar E. Iglesias                 tcg_gen_andi_tl(low, addr, 3);
1080403322eaSEdgar E. Iglesias                 tcg_gen_sub_tl(low, tcg_const_tl(3), low);
1081403322eaSEdgar E. Iglesias                 tcg_gen_andi_tl(addr, addr, ~3);
1082403322eaSEdgar E. Iglesias                 tcg_gen_or_tl(addr, addr, low);
1083403322eaSEdgar E. Iglesias                 tcg_temp_free(low);
1084fcf5ef2aSThomas Huth                 break;
1085fcf5ef2aSThomas Huth             }
1086fcf5ef2aSThomas Huth 
1087fcf5ef2aSThomas Huth             case 2:
1088fcf5ef2aSThomas Huth                 /* 00 -> 10
1089fcf5ef2aSThomas Huth                    10 -> 00.  */
1090fcf5ef2aSThomas Huth                 /* Force addr into the temp.  */
1091403322eaSEdgar E. Iglesias                 tcg_gen_xori_tl(addr, addr, 2);
1092fcf5ef2aSThomas Huth                 break;
1093fcf5ef2aSThomas Huth             default:
1094fcf5ef2aSThomas Huth                 cpu_abort(CPU(dc->cpu), "Invalid reverse size\n");
1095fcf5ef2aSThomas Huth                 break;
1096fcf5ef2aSThomas Huth         }
1097fcf5ef2aSThomas Huth     }
10980dc4af5cSEdgar E. Iglesias     tcg_gen_qemu_st_i32(cpu_R[dc->rd], addr,
1099cfeea807SEdgar E. Iglesias                         cpu_mmu_index(&dc->cpu->env, false), mop);
1100fcf5ef2aSThomas Huth 
1101fcf5ef2aSThomas Huth     /* Verify alignment if needed.  */
1102fcf5ef2aSThomas Huth     if ((dc->cpu->env.pvr.regs[2] & PVR2_UNALIGNED_EXC_MASK) && size > 1) {
1103cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc);
1104fcf5ef2aSThomas Huth         /* FIXME: if the alignment is wrong, we should restore the value
1105fcf5ef2aSThomas Huth          *        in memory. One possible way to achieve this is to probe
1106fcf5ef2aSThomas Huth          *        the MMU prior to the memaccess, thay way we could put
1107fcf5ef2aSThomas Huth          *        the alignment checks in between the probe and the mem
1108fcf5ef2aSThomas Huth          *        access.
1109fcf5ef2aSThomas Huth          */
11100dc4af5cSEdgar E. Iglesias         gen_helper_memalign(cpu_env, addr, tcg_const_i32(dc->rd),
1111cfeea807SEdgar E. Iglesias                             tcg_const_i32(1), tcg_const_i32(size - 1));
1112fcf5ef2aSThomas Huth     }
1113fcf5ef2aSThomas Huth 
1114fcf5ef2aSThomas Huth     if (ex) {
1115fcf5ef2aSThomas Huth         gen_set_label(swx_skip);
1116fcf5ef2aSThomas Huth     }
1117fcf5ef2aSThomas Huth 
1118403322eaSEdgar E. Iglesias     tcg_temp_free(addr);
1119fcf5ef2aSThomas Huth }
1120fcf5ef2aSThomas Huth 
1121fcf5ef2aSThomas Huth static inline void eval_cc(DisasContext *dc, unsigned int cc,
1122cfeea807SEdgar E. Iglesias                            TCGv_i32 d, TCGv_i32 a, TCGv_i32 b)
1123fcf5ef2aSThomas Huth {
1124fcf5ef2aSThomas Huth     switch (cc) {
1125fcf5ef2aSThomas Huth         case CC_EQ:
1126cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_EQ, d, a, b);
1127fcf5ef2aSThomas Huth             break;
1128fcf5ef2aSThomas Huth         case CC_NE:
1129cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_NE, d, a, b);
1130fcf5ef2aSThomas Huth             break;
1131fcf5ef2aSThomas Huth         case CC_LT:
1132cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_LT, d, a, b);
1133fcf5ef2aSThomas Huth             break;
1134fcf5ef2aSThomas Huth         case CC_LE:
1135cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_LE, d, a, b);
1136fcf5ef2aSThomas Huth             break;
1137fcf5ef2aSThomas Huth         case CC_GE:
1138cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_GE, d, a, b);
1139fcf5ef2aSThomas Huth             break;
1140fcf5ef2aSThomas Huth         case CC_GT:
1141cfeea807SEdgar E. Iglesias             tcg_gen_setcond_i32(TCG_COND_GT, d, a, b);
1142fcf5ef2aSThomas Huth             break;
1143fcf5ef2aSThomas Huth         default:
1144fcf5ef2aSThomas Huth             cpu_abort(CPU(dc->cpu), "Unknown condition code %x.\n", cc);
1145fcf5ef2aSThomas Huth             break;
1146fcf5ef2aSThomas Huth     }
1147fcf5ef2aSThomas Huth }
1148fcf5ef2aSThomas Huth 
1149cfeea807SEdgar E. Iglesias static void eval_cond_jmp(DisasContext *dc, TCGv_i32 pc_true, TCGv_i32 pc_false)
1150fcf5ef2aSThomas Huth {
1151fcf5ef2aSThomas Huth     TCGLabel *l1 = gen_new_label();
1152fcf5ef2aSThomas Huth     /* Conditional jmp.  */
1153cfeea807SEdgar E. Iglesias     tcg_gen_mov_i32(cpu_SR[SR_PC], pc_false);
1154cfeea807SEdgar E. Iglesias     tcg_gen_brcondi_i32(TCG_COND_EQ, env_btaken, 0, l1);
1155cfeea807SEdgar E. Iglesias     tcg_gen_mov_i32(cpu_SR[SR_PC], pc_true);
1156fcf5ef2aSThomas Huth     gen_set_label(l1);
1157fcf5ef2aSThomas Huth }
1158fcf5ef2aSThomas Huth 
1159fcf5ef2aSThomas Huth static void dec_bcc(DisasContext *dc)
1160fcf5ef2aSThomas Huth {
1161fcf5ef2aSThomas Huth     unsigned int cc;
1162fcf5ef2aSThomas Huth     unsigned int dslot;
1163fcf5ef2aSThomas Huth 
1164fcf5ef2aSThomas Huth     cc = EXTRACT_FIELD(dc->ir, 21, 23);
1165fcf5ef2aSThomas Huth     dslot = dc->ir & (1 << 25);
1166fcf5ef2aSThomas Huth     LOG_DIS("bcc%s r%d %x\n", dslot ? "d" : "", dc->ra, dc->imm);
1167fcf5ef2aSThomas Huth 
1168fcf5ef2aSThomas Huth     dc->delayed_branch = 1;
1169fcf5ef2aSThomas Huth     if (dslot) {
1170fcf5ef2aSThomas Huth         dc->delayed_branch = 2;
1171fcf5ef2aSThomas Huth         dc->tb_flags |= D_FLAG;
1172cfeea807SEdgar E. Iglesias         tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1173fcf5ef2aSThomas Huth                       cpu_env, offsetof(CPUMBState, bimm));
1174fcf5ef2aSThomas Huth     }
1175fcf5ef2aSThomas Huth 
1176fcf5ef2aSThomas Huth     if (dec_alu_op_b_is_small_imm(dc)) {
1177fcf5ef2aSThomas Huth         int32_t offset = (int32_t)((int16_t)dc->imm); /* sign-extend.  */
1178fcf5ef2aSThomas Huth 
1179cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(env_btarget, dc->pc + offset);
1180fcf5ef2aSThomas Huth         dc->jmp = JMP_DIRECT_CC;
1181fcf5ef2aSThomas Huth         dc->jmp_pc = dc->pc + offset;
1182fcf5ef2aSThomas Huth     } else {
1183fcf5ef2aSThomas Huth         dc->jmp = JMP_INDIRECT;
1184cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(env_btarget, dc->pc);
1185cfeea807SEdgar E. Iglesias         tcg_gen_add_i32(env_btarget, env_btarget, *(dec_alu_op_b(dc)));
1186fcf5ef2aSThomas Huth     }
1187cfeea807SEdgar E. Iglesias     eval_cc(dc, cc, env_btaken, cpu_R[dc->ra], tcg_const_i32(0));
1188fcf5ef2aSThomas Huth }
1189fcf5ef2aSThomas Huth 
1190fcf5ef2aSThomas Huth static void dec_br(DisasContext *dc)
1191fcf5ef2aSThomas Huth {
1192fcf5ef2aSThomas Huth     unsigned int dslot, link, abs, mbar;
1193fcf5ef2aSThomas Huth 
1194fcf5ef2aSThomas Huth     dslot = dc->ir & (1 << 20);
1195fcf5ef2aSThomas Huth     abs = dc->ir & (1 << 19);
1196fcf5ef2aSThomas Huth     link = dc->ir & (1 << 18);
1197fcf5ef2aSThomas Huth 
1198fcf5ef2aSThomas Huth     /* Memory barrier.  */
1199fcf5ef2aSThomas Huth     mbar = (dc->ir >> 16) & 31;
1200fcf5ef2aSThomas Huth     if (mbar == 2 && dc->imm == 4) {
1201fcf5ef2aSThomas Huth         /* mbar IMM & 16 decodes to sleep.  */
1202fcf5ef2aSThomas Huth         if (dc->rd & 16) {
1203fcf5ef2aSThomas Huth             TCGv_i32 tmp_hlt = tcg_const_i32(EXCP_HLT);
1204fcf5ef2aSThomas Huth             TCGv_i32 tmp_1 = tcg_const_i32(1);
1205fcf5ef2aSThomas Huth 
1206fcf5ef2aSThomas Huth             LOG_DIS("sleep\n");
1207fcf5ef2aSThomas Huth 
1208fcf5ef2aSThomas Huth             t_sync_flags(dc);
1209fcf5ef2aSThomas Huth             tcg_gen_st_i32(tmp_1, cpu_env,
1210fcf5ef2aSThomas Huth                            -offsetof(MicroBlazeCPU, env)
1211fcf5ef2aSThomas Huth                            +offsetof(CPUState, halted));
1212cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc + 4);
1213fcf5ef2aSThomas Huth             gen_helper_raise_exception(cpu_env, tmp_hlt);
1214fcf5ef2aSThomas Huth             tcg_temp_free_i32(tmp_hlt);
1215fcf5ef2aSThomas Huth             tcg_temp_free_i32(tmp_1);
1216fcf5ef2aSThomas Huth             return;
1217fcf5ef2aSThomas Huth         }
1218fcf5ef2aSThomas Huth         LOG_DIS("mbar %d\n", dc->rd);
1219fcf5ef2aSThomas Huth         /* Break the TB.  */
1220fcf5ef2aSThomas Huth         dc->cpustate_changed = 1;
1221fcf5ef2aSThomas Huth         return;
1222fcf5ef2aSThomas Huth     }
1223fcf5ef2aSThomas Huth 
1224fcf5ef2aSThomas Huth     LOG_DIS("br%s%s%s%s imm=%x\n",
1225fcf5ef2aSThomas Huth              abs ? "a" : "", link ? "l" : "",
1226fcf5ef2aSThomas Huth              dc->type_b ? "i" : "", dslot ? "d" : "",
1227fcf5ef2aSThomas Huth              dc->imm);
1228fcf5ef2aSThomas Huth 
1229fcf5ef2aSThomas Huth     dc->delayed_branch = 1;
1230fcf5ef2aSThomas Huth     if (dslot) {
1231fcf5ef2aSThomas Huth         dc->delayed_branch = 2;
1232fcf5ef2aSThomas Huth         dc->tb_flags |= D_FLAG;
1233cfeea807SEdgar E. Iglesias         tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1234fcf5ef2aSThomas Huth                       cpu_env, offsetof(CPUMBState, bimm));
1235fcf5ef2aSThomas Huth     }
1236fcf5ef2aSThomas Huth     if (link && dc->rd)
1237cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_R[dc->rd], dc->pc);
1238fcf5ef2aSThomas Huth 
1239fcf5ef2aSThomas Huth     dc->jmp = JMP_INDIRECT;
1240fcf5ef2aSThomas Huth     if (abs) {
1241cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(env_btaken, 1);
1242cfeea807SEdgar E. Iglesias         tcg_gen_mov_i32(env_btarget, *(dec_alu_op_b(dc)));
1243fcf5ef2aSThomas Huth         if (link && !dslot) {
1244fcf5ef2aSThomas Huth             if (!(dc->tb_flags & IMM_FLAG) && (dc->imm == 8 || dc->imm == 0x18))
1245fcf5ef2aSThomas Huth                 t_gen_raise_exception(dc, EXCP_BREAK);
1246fcf5ef2aSThomas Huth             if (dc->imm == 0) {
1247bdfc1e88SEdgar E. Iglesias                 if (trap_userspace(dc, true)) {
1248fcf5ef2aSThomas Huth                     return;
1249fcf5ef2aSThomas Huth                 }
1250fcf5ef2aSThomas Huth 
1251fcf5ef2aSThomas Huth                 t_gen_raise_exception(dc, EXCP_DEBUG);
1252fcf5ef2aSThomas Huth             }
1253fcf5ef2aSThomas Huth         }
1254fcf5ef2aSThomas Huth     } else {
1255fcf5ef2aSThomas Huth         if (dec_alu_op_b_is_small_imm(dc)) {
1256fcf5ef2aSThomas Huth             dc->jmp = JMP_DIRECT;
1257fcf5ef2aSThomas Huth             dc->jmp_pc = dc->pc + (int32_t)((int16_t)dc->imm);
1258fcf5ef2aSThomas Huth         } else {
1259cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(env_btaken, 1);
1260cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(env_btarget, dc->pc);
1261cfeea807SEdgar E. Iglesias             tcg_gen_add_i32(env_btarget, env_btarget, *(dec_alu_op_b(dc)));
1262fcf5ef2aSThomas Huth         }
1263fcf5ef2aSThomas Huth     }
1264fcf5ef2aSThomas Huth }
1265fcf5ef2aSThomas Huth 
1266fcf5ef2aSThomas Huth static inline void do_rti(DisasContext *dc)
1267fcf5ef2aSThomas Huth {
1268cfeea807SEdgar E. Iglesias     TCGv_i32 t0, t1;
1269cfeea807SEdgar E. Iglesias     t0 = tcg_temp_new_i32();
1270cfeea807SEdgar E. Iglesias     t1 = tcg_temp_new_i32();
1271cfeea807SEdgar E. Iglesias     tcg_gen_shri_i32(t0, cpu_SR[SR_MSR], 1);
1272cfeea807SEdgar E. Iglesias     tcg_gen_ori_i32(t1, cpu_SR[SR_MSR], MSR_IE);
1273cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM));
1274fcf5ef2aSThomas Huth 
1275cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM));
1276cfeea807SEdgar E. Iglesias     tcg_gen_or_i32(t1, t1, t0);
1277fcf5ef2aSThomas Huth     msr_write(dc, t1);
1278cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t1);
1279cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t0);
1280fcf5ef2aSThomas Huth     dc->tb_flags &= ~DRTI_FLAG;
1281fcf5ef2aSThomas Huth }
1282fcf5ef2aSThomas Huth 
1283fcf5ef2aSThomas Huth static inline void do_rtb(DisasContext *dc)
1284fcf5ef2aSThomas Huth {
1285cfeea807SEdgar E. Iglesias     TCGv_i32 t0, t1;
1286cfeea807SEdgar E. Iglesias     t0 = tcg_temp_new_i32();
1287cfeea807SEdgar E. Iglesias     t1 = tcg_temp_new_i32();
1288cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t1, cpu_SR[SR_MSR], ~MSR_BIP);
1289cfeea807SEdgar E. Iglesias     tcg_gen_shri_i32(t0, t1, 1);
1290cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM));
1291fcf5ef2aSThomas Huth 
1292cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM));
1293cfeea807SEdgar E. Iglesias     tcg_gen_or_i32(t1, t1, t0);
1294fcf5ef2aSThomas Huth     msr_write(dc, t1);
1295cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t1);
1296cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t0);
1297fcf5ef2aSThomas Huth     dc->tb_flags &= ~DRTB_FLAG;
1298fcf5ef2aSThomas Huth }
1299fcf5ef2aSThomas Huth 
1300fcf5ef2aSThomas Huth static inline void do_rte(DisasContext *dc)
1301fcf5ef2aSThomas Huth {
1302cfeea807SEdgar E. Iglesias     TCGv_i32 t0, t1;
1303cfeea807SEdgar E. Iglesias     t0 = tcg_temp_new_i32();
1304cfeea807SEdgar E. Iglesias     t1 = tcg_temp_new_i32();
1305fcf5ef2aSThomas Huth 
1306cfeea807SEdgar E. Iglesias     tcg_gen_ori_i32(t1, cpu_SR[SR_MSR], MSR_EE);
1307cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t1, t1, ~MSR_EIP);
1308cfeea807SEdgar E. Iglesias     tcg_gen_shri_i32(t0, t1, 1);
1309cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t0, t0, (MSR_VM | MSR_UM));
1310fcf5ef2aSThomas Huth 
1311cfeea807SEdgar E. Iglesias     tcg_gen_andi_i32(t1, t1, ~(MSR_VM | MSR_UM));
1312cfeea807SEdgar E. Iglesias     tcg_gen_or_i32(t1, t1, t0);
1313fcf5ef2aSThomas Huth     msr_write(dc, t1);
1314cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t1);
1315cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t0);
1316fcf5ef2aSThomas Huth     dc->tb_flags &= ~DRTE_FLAG;
1317fcf5ef2aSThomas Huth }
1318fcf5ef2aSThomas Huth 
1319fcf5ef2aSThomas Huth static void dec_rts(DisasContext *dc)
1320fcf5ef2aSThomas Huth {
1321fcf5ef2aSThomas Huth     unsigned int b_bit, i_bit, e_bit;
1322fcf5ef2aSThomas Huth 
1323fcf5ef2aSThomas Huth     i_bit = dc->ir & (1 << 21);
1324fcf5ef2aSThomas Huth     b_bit = dc->ir & (1 << 22);
1325fcf5ef2aSThomas Huth     e_bit = dc->ir & (1 << 23);
1326fcf5ef2aSThomas Huth 
1327bdfc1e88SEdgar E. Iglesias     if (trap_userspace(dc, i_bit || b_bit || e_bit)) {
1328bdfc1e88SEdgar E. Iglesias         return;
1329bdfc1e88SEdgar E. Iglesias     }
1330bdfc1e88SEdgar E. Iglesias 
1331fcf5ef2aSThomas Huth     dc->delayed_branch = 2;
1332fcf5ef2aSThomas Huth     dc->tb_flags |= D_FLAG;
1333cfeea807SEdgar E. Iglesias     tcg_gen_st_i32(tcg_const_i32(dc->type_b && (dc->tb_flags & IMM_FLAG)),
1334fcf5ef2aSThomas Huth                   cpu_env, offsetof(CPUMBState, bimm));
1335fcf5ef2aSThomas Huth 
1336fcf5ef2aSThomas Huth     if (i_bit) {
1337fcf5ef2aSThomas Huth         LOG_DIS("rtid ir=%x\n", dc->ir);
1338fcf5ef2aSThomas Huth         dc->tb_flags |= DRTI_FLAG;
1339fcf5ef2aSThomas Huth     } else if (b_bit) {
1340fcf5ef2aSThomas Huth         LOG_DIS("rtbd ir=%x\n", dc->ir);
1341fcf5ef2aSThomas Huth         dc->tb_flags |= DRTB_FLAG;
1342fcf5ef2aSThomas Huth     } else if (e_bit) {
1343fcf5ef2aSThomas Huth         LOG_DIS("rted ir=%x\n", dc->ir);
1344fcf5ef2aSThomas Huth         dc->tb_flags |= DRTE_FLAG;
1345fcf5ef2aSThomas Huth     } else
1346fcf5ef2aSThomas Huth         LOG_DIS("rts ir=%x\n", dc->ir);
1347fcf5ef2aSThomas Huth 
1348fcf5ef2aSThomas Huth     dc->jmp = JMP_INDIRECT;
1349cfeea807SEdgar E. Iglesias     tcg_gen_movi_i32(env_btaken, 1);
1350cfeea807SEdgar E. Iglesias     tcg_gen_add_i32(env_btarget, cpu_R[dc->ra], *(dec_alu_op_b(dc)));
1351fcf5ef2aSThomas Huth }
1352fcf5ef2aSThomas Huth 
1353fcf5ef2aSThomas Huth static int dec_check_fpuv2(DisasContext *dc)
1354fcf5ef2aSThomas Huth {
1355fcf5ef2aSThomas Huth     if ((dc->cpu->cfg.use_fpu != 2) && (dc->tb_flags & MSR_EE_FLAG)) {
1356cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_ESR], ESR_EC_FPU);
1357fcf5ef2aSThomas Huth         t_gen_raise_exception(dc, EXCP_HW_EXCP);
1358fcf5ef2aSThomas Huth     }
1359fcf5ef2aSThomas Huth     return (dc->cpu->cfg.use_fpu == 2) ? 0 : PVR2_USE_FPU2_MASK;
1360fcf5ef2aSThomas Huth }
1361fcf5ef2aSThomas Huth 
1362fcf5ef2aSThomas Huth static void dec_fpu(DisasContext *dc)
1363fcf5ef2aSThomas Huth {
1364fcf5ef2aSThomas Huth     unsigned int fpu_insn;
1365fcf5ef2aSThomas Huth 
13669ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, !dc->cpu->cfg.use_fpu)) {
1367fcf5ef2aSThomas Huth         return;
1368fcf5ef2aSThomas Huth     }
1369fcf5ef2aSThomas Huth 
1370fcf5ef2aSThomas Huth     fpu_insn = (dc->ir >> 7) & 7;
1371fcf5ef2aSThomas Huth 
1372fcf5ef2aSThomas Huth     switch (fpu_insn) {
1373fcf5ef2aSThomas Huth         case 0:
1374fcf5ef2aSThomas Huth             gen_helper_fadd(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1375fcf5ef2aSThomas Huth                             cpu_R[dc->rb]);
1376fcf5ef2aSThomas Huth             break;
1377fcf5ef2aSThomas Huth 
1378fcf5ef2aSThomas Huth         case 1:
1379fcf5ef2aSThomas Huth             gen_helper_frsub(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1380fcf5ef2aSThomas Huth                              cpu_R[dc->rb]);
1381fcf5ef2aSThomas Huth             break;
1382fcf5ef2aSThomas Huth 
1383fcf5ef2aSThomas Huth         case 2:
1384fcf5ef2aSThomas Huth             gen_helper_fmul(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1385fcf5ef2aSThomas Huth                             cpu_R[dc->rb]);
1386fcf5ef2aSThomas Huth             break;
1387fcf5ef2aSThomas Huth 
1388fcf5ef2aSThomas Huth         case 3:
1389fcf5ef2aSThomas Huth             gen_helper_fdiv(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra],
1390fcf5ef2aSThomas Huth                             cpu_R[dc->rb]);
1391fcf5ef2aSThomas Huth             break;
1392fcf5ef2aSThomas Huth 
1393fcf5ef2aSThomas Huth         case 4:
1394fcf5ef2aSThomas Huth             switch ((dc->ir >> 4) & 7) {
1395fcf5ef2aSThomas Huth                 case 0:
1396fcf5ef2aSThomas Huth                     gen_helper_fcmp_un(cpu_R[dc->rd], cpu_env,
1397fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1398fcf5ef2aSThomas Huth                     break;
1399fcf5ef2aSThomas Huth                 case 1:
1400fcf5ef2aSThomas Huth                     gen_helper_fcmp_lt(cpu_R[dc->rd], cpu_env,
1401fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1402fcf5ef2aSThomas Huth                     break;
1403fcf5ef2aSThomas Huth                 case 2:
1404fcf5ef2aSThomas Huth                     gen_helper_fcmp_eq(cpu_R[dc->rd], cpu_env,
1405fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1406fcf5ef2aSThomas Huth                     break;
1407fcf5ef2aSThomas Huth                 case 3:
1408fcf5ef2aSThomas Huth                     gen_helper_fcmp_le(cpu_R[dc->rd], cpu_env,
1409fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1410fcf5ef2aSThomas Huth                     break;
1411fcf5ef2aSThomas Huth                 case 4:
1412fcf5ef2aSThomas Huth                     gen_helper_fcmp_gt(cpu_R[dc->rd], cpu_env,
1413fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1414fcf5ef2aSThomas Huth                     break;
1415fcf5ef2aSThomas Huth                 case 5:
1416fcf5ef2aSThomas Huth                     gen_helper_fcmp_ne(cpu_R[dc->rd], cpu_env,
1417fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1418fcf5ef2aSThomas Huth                     break;
1419fcf5ef2aSThomas Huth                 case 6:
1420fcf5ef2aSThomas Huth                     gen_helper_fcmp_ge(cpu_R[dc->rd], cpu_env,
1421fcf5ef2aSThomas Huth                                        cpu_R[dc->ra], cpu_R[dc->rb]);
1422fcf5ef2aSThomas Huth                     break;
1423fcf5ef2aSThomas Huth                 default:
1424fcf5ef2aSThomas Huth                     qemu_log_mask(LOG_UNIMP,
1425fcf5ef2aSThomas Huth                                   "unimplemented fcmp fpu_insn=%x pc=%x"
1426fcf5ef2aSThomas Huth                                   " opc=%x\n",
1427fcf5ef2aSThomas Huth                                   fpu_insn, dc->pc, dc->opcode);
1428fcf5ef2aSThomas Huth                     dc->abort_at_next_insn = 1;
1429fcf5ef2aSThomas Huth                     break;
1430fcf5ef2aSThomas Huth             }
1431fcf5ef2aSThomas Huth             break;
1432fcf5ef2aSThomas Huth 
1433fcf5ef2aSThomas Huth         case 5:
1434fcf5ef2aSThomas Huth             if (!dec_check_fpuv2(dc)) {
1435fcf5ef2aSThomas Huth                 return;
1436fcf5ef2aSThomas Huth             }
1437fcf5ef2aSThomas Huth             gen_helper_flt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1438fcf5ef2aSThomas Huth             break;
1439fcf5ef2aSThomas Huth 
1440fcf5ef2aSThomas Huth         case 6:
1441fcf5ef2aSThomas Huth             if (!dec_check_fpuv2(dc)) {
1442fcf5ef2aSThomas Huth                 return;
1443fcf5ef2aSThomas Huth             }
1444fcf5ef2aSThomas Huth             gen_helper_fint(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1445fcf5ef2aSThomas Huth             break;
1446fcf5ef2aSThomas Huth 
1447fcf5ef2aSThomas Huth         case 7:
1448fcf5ef2aSThomas Huth             if (!dec_check_fpuv2(dc)) {
1449fcf5ef2aSThomas Huth                 return;
1450fcf5ef2aSThomas Huth             }
1451fcf5ef2aSThomas Huth             gen_helper_fsqrt(cpu_R[dc->rd], cpu_env, cpu_R[dc->ra]);
1452fcf5ef2aSThomas Huth             break;
1453fcf5ef2aSThomas Huth 
1454fcf5ef2aSThomas Huth         default:
1455fcf5ef2aSThomas Huth             qemu_log_mask(LOG_UNIMP, "unimplemented FPU insn fpu_insn=%x pc=%x"
1456fcf5ef2aSThomas Huth                           " opc=%x\n",
1457fcf5ef2aSThomas Huth                           fpu_insn, dc->pc, dc->opcode);
1458fcf5ef2aSThomas Huth             dc->abort_at_next_insn = 1;
1459fcf5ef2aSThomas Huth             break;
1460fcf5ef2aSThomas Huth     }
1461fcf5ef2aSThomas Huth }
1462fcf5ef2aSThomas Huth 
1463fcf5ef2aSThomas Huth static void dec_null(DisasContext *dc)
1464fcf5ef2aSThomas Huth {
14659ba8cd45SEdgar E. Iglesias     if (trap_illegal(dc, true)) {
1466fcf5ef2aSThomas Huth         return;
1467fcf5ef2aSThomas Huth     }
1468fcf5ef2aSThomas Huth     qemu_log_mask(LOG_GUEST_ERROR, "unknown insn pc=%x opc=%x\n", dc->pc, dc->opcode);
1469fcf5ef2aSThomas Huth     dc->abort_at_next_insn = 1;
1470fcf5ef2aSThomas Huth }
1471fcf5ef2aSThomas Huth 
1472fcf5ef2aSThomas Huth /* Insns connected to FSL or AXI stream attached devices.  */
1473fcf5ef2aSThomas Huth static void dec_stream(DisasContext *dc)
1474fcf5ef2aSThomas Huth {
1475fcf5ef2aSThomas Huth     TCGv_i32 t_id, t_ctrl;
1476fcf5ef2aSThomas Huth     int ctrl;
1477fcf5ef2aSThomas Huth 
1478fcf5ef2aSThomas Huth     LOG_DIS("%s%s imm=%x\n", dc->rd ? "get" : "put",
1479fcf5ef2aSThomas Huth             dc->type_b ? "" : "d", dc->imm);
1480fcf5ef2aSThomas Huth 
1481bdfc1e88SEdgar E. Iglesias     if (trap_userspace(dc, true)) {
1482fcf5ef2aSThomas Huth         return;
1483fcf5ef2aSThomas Huth     }
1484fcf5ef2aSThomas Huth 
1485cfeea807SEdgar E. Iglesias     t_id = tcg_temp_new_i32();
1486fcf5ef2aSThomas Huth     if (dc->type_b) {
1487cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(t_id, dc->imm & 0xf);
1488fcf5ef2aSThomas Huth         ctrl = dc->imm >> 10;
1489fcf5ef2aSThomas Huth     } else {
1490cfeea807SEdgar E. Iglesias         tcg_gen_andi_i32(t_id, cpu_R[dc->rb], 0xf);
1491fcf5ef2aSThomas Huth         ctrl = dc->imm >> 5;
1492fcf5ef2aSThomas Huth     }
1493fcf5ef2aSThomas Huth 
1494cfeea807SEdgar E. Iglesias     t_ctrl = tcg_const_i32(ctrl);
1495fcf5ef2aSThomas Huth 
1496fcf5ef2aSThomas Huth     if (dc->rd == 0) {
1497fcf5ef2aSThomas Huth         gen_helper_put(t_id, t_ctrl, cpu_R[dc->ra]);
1498fcf5ef2aSThomas Huth     } else {
1499fcf5ef2aSThomas Huth         gen_helper_get(cpu_R[dc->rd], t_id, t_ctrl);
1500fcf5ef2aSThomas Huth     }
1501cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t_id);
1502cfeea807SEdgar E. Iglesias     tcg_temp_free_i32(t_ctrl);
1503fcf5ef2aSThomas Huth }
1504fcf5ef2aSThomas Huth 
1505fcf5ef2aSThomas Huth static struct decoder_info {
1506fcf5ef2aSThomas Huth     struct {
1507fcf5ef2aSThomas Huth         uint32_t bits;
1508fcf5ef2aSThomas Huth         uint32_t mask;
1509fcf5ef2aSThomas Huth     };
1510fcf5ef2aSThomas Huth     void (*dec)(DisasContext *dc);
1511fcf5ef2aSThomas Huth } decinfo[] = {
1512fcf5ef2aSThomas Huth     {DEC_ADD, dec_add},
1513fcf5ef2aSThomas Huth     {DEC_SUB, dec_sub},
1514fcf5ef2aSThomas Huth     {DEC_AND, dec_and},
1515fcf5ef2aSThomas Huth     {DEC_XOR, dec_xor},
1516fcf5ef2aSThomas Huth     {DEC_OR, dec_or},
1517fcf5ef2aSThomas Huth     {DEC_BIT, dec_bit},
1518fcf5ef2aSThomas Huth     {DEC_BARREL, dec_barrel},
1519fcf5ef2aSThomas Huth     {DEC_LD, dec_load},
1520fcf5ef2aSThomas Huth     {DEC_ST, dec_store},
1521fcf5ef2aSThomas Huth     {DEC_IMM, dec_imm},
1522fcf5ef2aSThomas Huth     {DEC_BR, dec_br},
1523fcf5ef2aSThomas Huth     {DEC_BCC, dec_bcc},
1524fcf5ef2aSThomas Huth     {DEC_RTS, dec_rts},
1525fcf5ef2aSThomas Huth     {DEC_FPU, dec_fpu},
1526fcf5ef2aSThomas Huth     {DEC_MUL, dec_mul},
1527fcf5ef2aSThomas Huth     {DEC_DIV, dec_div},
1528fcf5ef2aSThomas Huth     {DEC_MSR, dec_msr},
1529fcf5ef2aSThomas Huth     {DEC_STREAM, dec_stream},
1530fcf5ef2aSThomas Huth     {{0, 0}, dec_null}
1531fcf5ef2aSThomas Huth };
1532fcf5ef2aSThomas Huth 
1533fcf5ef2aSThomas Huth static inline void decode(DisasContext *dc, uint32_t ir)
1534fcf5ef2aSThomas Huth {
1535fcf5ef2aSThomas Huth     int i;
1536fcf5ef2aSThomas Huth 
1537fcf5ef2aSThomas Huth     dc->ir = ir;
1538fcf5ef2aSThomas Huth     LOG_DIS("%8.8x\t", dc->ir);
1539fcf5ef2aSThomas Huth 
1540fcf5ef2aSThomas Huth     if (dc->ir)
1541fcf5ef2aSThomas Huth         dc->nr_nops = 0;
1542fcf5ef2aSThomas Huth     else {
15439ba8cd45SEdgar E. Iglesias         trap_illegal(dc, dc->cpu->env.pvr.regs[2] & PVR2_OPCODE_0x0_ILL_MASK);
1544fcf5ef2aSThomas Huth 
1545fcf5ef2aSThomas Huth         LOG_DIS("nr_nops=%d\t", dc->nr_nops);
1546fcf5ef2aSThomas Huth         dc->nr_nops++;
1547fcf5ef2aSThomas Huth         if (dc->nr_nops > 4) {
1548fcf5ef2aSThomas Huth             cpu_abort(CPU(dc->cpu), "fetching nop sequence\n");
1549fcf5ef2aSThomas Huth         }
1550fcf5ef2aSThomas Huth     }
1551fcf5ef2aSThomas Huth     /* bit 2 seems to indicate insn type.  */
1552fcf5ef2aSThomas Huth     dc->type_b = ir & (1 << 29);
1553fcf5ef2aSThomas Huth 
1554fcf5ef2aSThomas Huth     dc->opcode = EXTRACT_FIELD(ir, 26, 31);
1555fcf5ef2aSThomas Huth     dc->rd = EXTRACT_FIELD(ir, 21, 25);
1556fcf5ef2aSThomas Huth     dc->ra = EXTRACT_FIELD(ir, 16, 20);
1557fcf5ef2aSThomas Huth     dc->rb = EXTRACT_FIELD(ir, 11, 15);
1558fcf5ef2aSThomas Huth     dc->imm = EXTRACT_FIELD(ir, 0, 15);
1559fcf5ef2aSThomas Huth 
1560fcf5ef2aSThomas Huth     /* Large switch for all insns.  */
1561fcf5ef2aSThomas Huth     for (i = 0; i < ARRAY_SIZE(decinfo); i++) {
1562fcf5ef2aSThomas Huth         if ((dc->opcode & decinfo[i].mask) == decinfo[i].bits) {
1563fcf5ef2aSThomas Huth             decinfo[i].dec(dc);
1564fcf5ef2aSThomas Huth             break;
1565fcf5ef2aSThomas Huth         }
1566fcf5ef2aSThomas Huth     }
1567fcf5ef2aSThomas Huth }
1568fcf5ef2aSThomas Huth 
1569fcf5ef2aSThomas Huth /* generate intermediate code for basic block 'tb'.  */
15709c489ea6SLluís Vilanova void gen_intermediate_code(CPUState *cs, struct TranslationBlock *tb)
1571fcf5ef2aSThomas Huth {
15729c489ea6SLluís Vilanova     CPUMBState *env = cs->env_ptr;
1573fcf5ef2aSThomas Huth     MicroBlazeCPU *cpu = mb_env_get_cpu(env);
1574fcf5ef2aSThomas Huth     uint32_t pc_start;
1575fcf5ef2aSThomas Huth     struct DisasContext ctx;
1576fcf5ef2aSThomas Huth     struct DisasContext *dc = &ctx;
157756371527SEmilio G. Cota     uint32_t page_start, org_flags;
1578cfeea807SEdgar E. Iglesias     uint32_t npc;
1579fcf5ef2aSThomas Huth     int num_insns;
1580fcf5ef2aSThomas Huth     int max_insns;
1581fcf5ef2aSThomas Huth 
1582fcf5ef2aSThomas Huth     pc_start = tb->pc;
1583fcf5ef2aSThomas Huth     dc->cpu = cpu;
1584fcf5ef2aSThomas Huth     dc->tb = tb;
1585fcf5ef2aSThomas Huth     org_flags = dc->synced_flags = dc->tb_flags = tb->flags;
1586fcf5ef2aSThomas Huth 
1587fcf5ef2aSThomas Huth     dc->is_jmp = DISAS_NEXT;
1588fcf5ef2aSThomas Huth     dc->jmp = 0;
1589fcf5ef2aSThomas Huth     dc->delayed_branch = !!(dc->tb_flags & D_FLAG);
1590fcf5ef2aSThomas Huth     if (dc->delayed_branch) {
1591fcf5ef2aSThomas Huth         dc->jmp = JMP_INDIRECT;
1592fcf5ef2aSThomas Huth     }
1593fcf5ef2aSThomas Huth     dc->pc = pc_start;
1594fcf5ef2aSThomas Huth     dc->singlestep_enabled = cs->singlestep_enabled;
1595fcf5ef2aSThomas Huth     dc->cpustate_changed = 0;
1596fcf5ef2aSThomas Huth     dc->abort_at_next_insn = 0;
1597fcf5ef2aSThomas Huth     dc->nr_nops = 0;
1598fcf5ef2aSThomas Huth 
1599fcf5ef2aSThomas Huth     if (pc_start & 3) {
1600fcf5ef2aSThomas Huth         cpu_abort(cs, "Microblaze: unaligned PC=%x\n", pc_start);
1601fcf5ef2aSThomas Huth     }
1602fcf5ef2aSThomas Huth 
160356371527SEmilio G. Cota     page_start = pc_start & TARGET_PAGE_MASK;
1604fcf5ef2aSThomas Huth     num_insns = 0;
1605c5a49c63SEmilio G. Cota     max_insns = tb_cflags(tb) & CF_COUNT_MASK;
1606fcf5ef2aSThomas Huth     if (max_insns == 0) {
1607fcf5ef2aSThomas Huth         max_insns = CF_COUNT_MASK;
1608fcf5ef2aSThomas Huth     }
1609fcf5ef2aSThomas Huth     if (max_insns > TCG_MAX_INSNS) {
1610fcf5ef2aSThomas Huth         max_insns = TCG_MAX_INSNS;
1611fcf5ef2aSThomas Huth     }
1612fcf5ef2aSThomas Huth 
1613fcf5ef2aSThomas Huth     gen_tb_start(tb);
1614fcf5ef2aSThomas Huth     do
1615fcf5ef2aSThomas Huth     {
1616fcf5ef2aSThomas Huth         tcg_gen_insn_start(dc->pc);
1617fcf5ef2aSThomas Huth         num_insns++;
1618fcf5ef2aSThomas Huth 
1619fcf5ef2aSThomas Huth #if SIM_COMPAT
1620fcf5ef2aSThomas Huth         if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1621cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(cpu_SR[SR_PC], dc->pc);
1622fcf5ef2aSThomas Huth             gen_helper_debug();
1623fcf5ef2aSThomas Huth         }
1624fcf5ef2aSThomas Huth #endif
1625fcf5ef2aSThomas Huth 
1626fcf5ef2aSThomas Huth         if (unlikely(cpu_breakpoint_test(cs, dc->pc, BP_ANY))) {
1627fcf5ef2aSThomas Huth             t_gen_raise_exception(dc, EXCP_DEBUG);
1628fcf5ef2aSThomas Huth             dc->is_jmp = DISAS_UPDATE;
1629fcf5ef2aSThomas Huth             /* The address covered by the breakpoint must be included in
1630fcf5ef2aSThomas Huth                [tb->pc, tb->pc + tb->size) in order to for it to be
1631fcf5ef2aSThomas Huth                properly cleared -- thus we increment the PC here so that
1632fcf5ef2aSThomas Huth                the logic setting tb->size below does the right thing.  */
1633fcf5ef2aSThomas Huth             dc->pc += 4;
1634fcf5ef2aSThomas Huth             break;
1635fcf5ef2aSThomas Huth         }
1636fcf5ef2aSThomas Huth 
1637fcf5ef2aSThomas Huth         /* Pretty disas.  */
1638fcf5ef2aSThomas Huth         LOG_DIS("%8.8x:\t", dc->pc);
1639fcf5ef2aSThomas Huth 
1640c5a49c63SEmilio G. Cota         if (num_insns == max_insns && (tb_cflags(tb) & CF_LAST_IO)) {
1641fcf5ef2aSThomas Huth             gen_io_start();
1642fcf5ef2aSThomas Huth         }
1643fcf5ef2aSThomas Huth 
1644fcf5ef2aSThomas Huth         dc->clear_imm = 1;
1645fcf5ef2aSThomas Huth         decode(dc, cpu_ldl_code(env, dc->pc));
1646fcf5ef2aSThomas Huth         if (dc->clear_imm)
1647fcf5ef2aSThomas Huth             dc->tb_flags &= ~IMM_FLAG;
1648fcf5ef2aSThomas Huth         dc->pc += 4;
1649fcf5ef2aSThomas Huth 
1650fcf5ef2aSThomas Huth         if (dc->delayed_branch) {
1651fcf5ef2aSThomas Huth             dc->delayed_branch--;
1652fcf5ef2aSThomas Huth             if (!dc->delayed_branch) {
1653fcf5ef2aSThomas Huth                 if (dc->tb_flags & DRTI_FLAG)
1654fcf5ef2aSThomas Huth                     do_rti(dc);
1655fcf5ef2aSThomas Huth                  if (dc->tb_flags & DRTB_FLAG)
1656fcf5ef2aSThomas Huth                     do_rtb(dc);
1657fcf5ef2aSThomas Huth                 if (dc->tb_flags & DRTE_FLAG)
1658fcf5ef2aSThomas Huth                     do_rte(dc);
1659fcf5ef2aSThomas Huth                 /* Clear the delay slot flag.  */
1660fcf5ef2aSThomas Huth                 dc->tb_flags &= ~D_FLAG;
1661fcf5ef2aSThomas Huth                 /* If it is a direct jump, try direct chaining.  */
1662fcf5ef2aSThomas Huth                 if (dc->jmp == JMP_INDIRECT) {
1663cfeea807SEdgar E. Iglesias                     eval_cond_jmp(dc, env_btarget, tcg_const_i32(dc->pc));
1664fcf5ef2aSThomas Huth                     dc->is_jmp = DISAS_JUMP;
1665fcf5ef2aSThomas Huth                 } else if (dc->jmp == JMP_DIRECT) {
1666fcf5ef2aSThomas Huth                     t_sync_flags(dc);
1667fcf5ef2aSThomas Huth                     gen_goto_tb(dc, 0, dc->jmp_pc);
1668fcf5ef2aSThomas Huth                     dc->is_jmp = DISAS_TB_JUMP;
1669fcf5ef2aSThomas Huth                 } else if (dc->jmp == JMP_DIRECT_CC) {
1670fcf5ef2aSThomas Huth                     TCGLabel *l1 = gen_new_label();
1671fcf5ef2aSThomas Huth                     t_sync_flags(dc);
1672fcf5ef2aSThomas Huth                     /* Conditional jmp.  */
1673cfeea807SEdgar E. Iglesias                     tcg_gen_brcondi_i32(TCG_COND_NE, env_btaken, 0, l1);
1674fcf5ef2aSThomas Huth                     gen_goto_tb(dc, 1, dc->pc);
1675fcf5ef2aSThomas Huth                     gen_set_label(l1);
1676fcf5ef2aSThomas Huth                     gen_goto_tb(dc, 0, dc->jmp_pc);
1677fcf5ef2aSThomas Huth 
1678fcf5ef2aSThomas Huth                     dc->is_jmp = DISAS_TB_JUMP;
1679fcf5ef2aSThomas Huth                 }
1680fcf5ef2aSThomas Huth                 break;
1681fcf5ef2aSThomas Huth             }
1682fcf5ef2aSThomas Huth         }
1683fcf5ef2aSThomas Huth         if (cs->singlestep_enabled) {
1684fcf5ef2aSThomas Huth             break;
1685fcf5ef2aSThomas Huth         }
1686fcf5ef2aSThomas Huth     } while (!dc->is_jmp && !dc->cpustate_changed
1687fcf5ef2aSThomas Huth              && !tcg_op_buf_full()
1688fcf5ef2aSThomas Huth              && !singlestep
168956371527SEmilio G. Cota              && (dc->pc - page_start < TARGET_PAGE_SIZE)
1690fcf5ef2aSThomas Huth              && num_insns < max_insns);
1691fcf5ef2aSThomas Huth 
1692fcf5ef2aSThomas Huth     npc = dc->pc;
1693fcf5ef2aSThomas Huth     if (dc->jmp == JMP_DIRECT || dc->jmp == JMP_DIRECT_CC) {
1694fcf5ef2aSThomas Huth         if (dc->tb_flags & D_FLAG) {
1695fcf5ef2aSThomas Huth             dc->is_jmp = DISAS_UPDATE;
1696cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(cpu_SR[SR_PC], npc);
1697fcf5ef2aSThomas Huth             sync_jmpstate(dc);
1698fcf5ef2aSThomas Huth         } else
1699fcf5ef2aSThomas Huth             npc = dc->jmp_pc;
1700fcf5ef2aSThomas Huth     }
1701fcf5ef2aSThomas Huth 
1702c5a49c63SEmilio G. Cota     if (tb_cflags(tb) & CF_LAST_IO)
1703fcf5ef2aSThomas Huth         gen_io_end();
1704fcf5ef2aSThomas Huth     /* Force an update if the per-tb cpu state has changed.  */
1705fcf5ef2aSThomas Huth     if (dc->is_jmp == DISAS_NEXT
1706fcf5ef2aSThomas Huth         && (dc->cpustate_changed || org_flags != dc->tb_flags)) {
1707fcf5ef2aSThomas Huth         dc->is_jmp = DISAS_UPDATE;
1708cfeea807SEdgar E. Iglesias         tcg_gen_movi_i32(cpu_SR[SR_PC], npc);
1709fcf5ef2aSThomas Huth     }
1710fcf5ef2aSThomas Huth     t_sync_flags(dc);
1711fcf5ef2aSThomas Huth 
1712fcf5ef2aSThomas Huth     if (unlikely(cs->singlestep_enabled)) {
1713fcf5ef2aSThomas Huth         TCGv_i32 tmp = tcg_const_i32(EXCP_DEBUG);
1714fcf5ef2aSThomas Huth 
1715fcf5ef2aSThomas Huth         if (dc->is_jmp != DISAS_JUMP) {
1716cfeea807SEdgar E. Iglesias             tcg_gen_movi_i32(cpu_SR[SR_PC], npc);
1717fcf5ef2aSThomas Huth         }
1718fcf5ef2aSThomas Huth         gen_helper_raise_exception(cpu_env, tmp);
1719fcf5ef2aSThomas Huth         tcg_temp_free_i32(tmp);
1720fcf5ef2aSThomas Huth     } else {
1721fcf5ef2aSThomas Huth         switch(dc->is_jmp) {
1722fcf5ef2aSThomas Huth             case DISAS_NEXT:
1723fcf5ef2aSThomas Huth                 gen_goto_tb(dc, 1, npc);
1724fcf5ef2aSThomas Huth                 break;
1725fcf5ef2aSThomas Huth             default:
1726fcf5ef2aSThomas Huth             case DISAS_JUMP:
1727fcf5ef2aSThomas Huth             case DISAS_UPDATE:
1728fcf5ef2aSThomas Huth                 /* indicate that the hash table must be used
1729fcf5ef2aSThomas Huth                    to find the next TB */
1730fcf5ef2aSThomas Huth                 tcg_gen_exit_tb(0);
1731fcf5ef2aSThomas Huth                 break;
1732fcf5ef2aSThomas Huth             case DISAS_TB_JUMP:
1733fcf5ef2aSThomas Huth                 /* nothing more to generate */
1734fcf5ef2aSThomas Huth                 break;
1735fcf5ef2aSThomas Huth         }
1736fcf5ef2aSThomas Huth     }
1737fcf5ef2aSThomas Huth     gen_tb_end(tb, num_insns);
1738fcf5ef2aSThomas Huth 
1739fcf5ef2aSThomas Huth     tb->size = dc->pc - pc_start;
1740fcf5ef2aSThomas Huth     tb->icount = num_insns;
1741fcf5ef2aSThomas Huth 
1742fcf5ef2aSThomas Huth #ifdef DEBUG_DISAS
1743fcf5ef2aSThomas Huth #if !SIM_COMPAT
1744fcf5ef2aSThomas Huth     if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)
1745fcf5ef2aSThomas Huth         && qemu_log_in_addr_range(pc_start)) {
1746fcf5ef2aSThomas Huth         qemu_log_lock();
1747fcf5ef2aSThomas Huth         qemu_log("--------------\n");
17481d48474dSRichard Henderson         log_target_disas(cs, pc_start, dc->pc - pc_start);
1749fcf5ef2aSThomas Huth         qemu_log_unlock();
1750fcf5ef2aSThomas Huth     }
1751fcf5ef2aSThomas Huth #endif
1752fcf5ef2aSThomas Huth #endif
1753fcf5ef2aSThomas Huth     assert(!dc->abort_at_next_insn);
1754fcf5ef2aSThomas Huth }
1755fcf5ef2aSThomas Huth 
1756fcf5ef2aSThomas Huth void mb_cpu_dump_state(CPUState *cs, FILE *f, fprintf_function cpu_fprintf,
1757fcf5ef2aSThomas Huth                        int flags)
1758fcf5ef2aSThomas Huth {
1759fcf5ef2aSThomas Huth     MicroBlazeCPU *cpu = MICROBLAZE_CPU(cs);
1760fcf5ef2aSThomas Huth     CPUMBState *env = &cpu->env;
1761fcf5ef2aSThomas Huth     int i;
1762fcf5ef2aSThomas Huth 
1763fcf5ef2aSThomas Huth     if (!env || !f)
1764fcf5ef2aSThomas Huth         return;
1765fcf5ef2aSThomas Huth 
1766fcf5ef2aSThomas Huth     cpu_fprintf(f, "IN: PC=%x %s\n",
1767fcf5ef2aSThomas Huth                 env->sregs[SR_PC], lookup_symbol(env->sregs[SR_PC]));
1768fcf5ef2aSThomas Huth     cpu_fprintf(f, "rmsr=%x resr=%x rear=%x debug=%x imm=%x iflags=%x fsr=%x\n",
1769fcf5ef2aSThomas Huth              env->sregs[SR_MSR], env->sregs[SR_ESR], env->sregs[SR_EAR],
1770fcf5ef2aSThomas Huth              env->debug, env->imm, env->iflags, env->sregs[SR_FSR]);
1771fcf5ef2aSThomas Huth     cpu_fprintf(f, "btaken=%d btarget=%x mode=%s(saved=%s) eip=%d ie=%d\n",
1772fcf5ef2aSThomas Huth              env->btaken, env->btarget,
1773fcf5ef2aSThomas Huth              (env->sregs[SR_MSR] & MSR_UM) ? "user" : "kernel",
1774fcf5ef2aSThomas Huth              (env->sregs[SR_MSR] & MSR_UMS) ? "user" : "kernel",
1775fcf5ef2aSThomas Huth              (env->sregs[SR_MSR] & MSR_EIP),
1776fcf5ef2aSThomas Huth              (env->sregs[SR_MSR] & MSR_IE));
1777fcf5ef2aSThomas Huth 
1778fcf5ef2aSThomas Huth     for (i = 0; i < 32; i++) {
1779fcf5ef2aSThomas Huth         cpu_fprintf(f, "r%2.2d=%8.8x ", i, env->regs[i]);
1780fcf5ef2aSThomas Huth         if ((i + 1) % 4 == 0)
1781fcf5ef2aSThomas Huth             cpu_fprintf(f, "\n");
1782fcf5ef2aSThomas Huth         }
1783fcf5ef2aSThomas Huth     cpu_fprintf(f, "\n\n");
1784fcf5ef2aSThomas Huth }
1785fcf5ef2aSThomas Huth 
1786fcf5ef2aSThomas Huth void mb_tcg_init(void)
1787fcf5ef2aSThomas Huth {
1788fcf5ef2aSThomas Huth     int i;
1789fcf5ef2aSThomas Huth 
1790cfeea807SEdgar E. Iglesias     env_debug = tcg_global_mem_new_i32(cpu_env,
1791fcf5ef2aSThomas Huth                     offsetof(CPUMBState, debug),
1792fcf5ef2aSThomas Huth                     "debug0");
1793cfeea807SEdgar E. Iglesias     env_iflags = tcg_global_mem_new_i32(cpu_env,
1794fcf5ef2aSThomas Huth                     offsetof(CPUMBState, iflags),
1795fcf5ef2aSThomas Huth                     "iflags");
1796cfeea807SEdgar E. Iglesias     env_imm = tcg_global_mem_new_i32(cpu_env,
1797fcf5ef2aSThomas Huth                     offsetof(CPUMBState, imm),
1798fcf5ef2aSThomas Huth                     "imm");
1799cfeea807SEdgar E. Iglesias     env_btarget = tcg_global_mem_new_i32(cpu_env,
1800fcf5ef2aSThomas Huth                      offsetof(CPUMBState, btarget),
1801fcf5ef2aSThomas Huth                      "btarget");
1802cfeea807SEdgar E. Iglesias     env_btaken = tcg_global_mem_new_i32(cpu_env,
1803fcf5ef2aSThomas Huth                      offsetof(CPUMBState, btaken),
1804fcf5ef2aSThomas Huth                      "btaken");
1805403322eaSEdgar E. Iglesias     env_res_addr = tcg_global_mem_new(cpu_env,
1806fcf5ef2aSThomas Huth                      offsetof(CPUMBState, res_addr),
1807fcf5ef2aSThomas Huth                      "res_addr");
1808cfeea807SEdgar E. Iglesias     env_res_val = tcg_global_mem_new_i32(cpu_env,
1809fcf5ef2aSThomas Huth                      offsetof(CPUMBState, res_val),
1810fcf5ef2aSThomas Huth                      "res_val");
1811fcf5ef2aSThomas Huth     for (i = 0; i < ARRAY_SIZE(cpu_R); i++) {
1812cfeea807SEdgar E. Iglesias         cpu_R[i] = tcg_global_mem_new_i32(cpu_env,
1813fcf5ef2aSThomas Huth                           offsetof(CPUMBState, regs[i]),
1814fcf5ef2aSThomas Huth                           regnames[i]);
1815fcf5ef2aSThomas Huth     }
1816fcf5ef2aSThomas Huth     for (i = 0; i < ARRAY_SIZE(cpu_SR); i++) {
1817cfeea807SEdgar E. Iglesias         cpu_SR[i] = tcg_global_mem_new_i32(cpu_env,
1818fcf5ef2aSThomas Huth                           offsetof(CPUMBState, sregs[i]),
1819fcf5ef2aSThomas Huth                           special_regnames[i]);
1820fcf5ef2aSThomas Huth     }
1821fcf5ef2aSThomas Huth }
1822fcf5ef2aSThomas Huth 
1823fcf5ef2aSThomas Huth void restore_state_to_opc(CPUMBState *env, TranslationBlock *tb,
1824fcf5ef2aSThomas Huth                           target_ulong *data)
1825fcf5ef2aSThomas Huth {
1826fcf5ef2aSThomas Huth     env->sregs[SR_PC] = data[0];
1827fcf5ef2aSThomas Huth }
1828