1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "cpu.h"
21#include "disas/disas.h"
22#include "helper.h"
23#include "tcg-op.h"
24
25#include "hw/lm32_pic.h"
26
27#define GEN_HELPER 1
28#include "helper.h"
29
30#define DISAS_LM32 1
31#if DISAS_LM32
32# define LOG_DIS(...) qemu_log_mask(CPU_LOG_TB_IN_ASM, ## __VA_ARGS__)
33#else
34# define LOG_DIS(...) do { } while (0)
35#endif
36
37#define EXTRACT_FIELD(src, start, end) \
38 (((src) >> start) & ((1 << (end - start + 1)) - 1))
39
40#define MEM_INDEX 0
41
42static TCGv_ptr cpu_env;
43static TCGv cpu_R[32];
44static TCGv cpu_pc;
45static TCGv cpu_ie;
46static TCGv cpu_icc;
47static TCGv cpu_dcc;
48static TCGv cpu_cc;
49static TCGv cpu_cfg;
50static TCGv cpu_eba;
51static TCGv cpu_dc;
52static TCGv cpu_deba;
53static TCGv cpu_bp[4];
54static TCGv cpu_wp[4];
55
56#include "exec/gen-icount.h"
57
58enum {
59 OP_FMT_RI,
60 OP_FMT_RR,
61 OP_FMT_CR,
62 OP_FMT_I
63};
64
65
66typedef struct DisasContext {
67 CPULM32State *env;
68 target_ulong pc;
69
70
71 int format;
72 uint32_t ir;
73 uint8_t opcode;
74 uint8_t r0, r1, r2, csr;
75 uint16_t imm5;
76 uint16_t imm16;
77 uint32_t imm26;
78
79 unsigned int delayed_branch;
80 unsigned int tb_flags, synced_flags;
81 int is_jmp;
82
83 int nr_nops;
84 struct TranslationBlock *tb;
85 int singlestep_enabled;
86} DisasContext;
87
88static const char *regnames[] = {
89 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
90 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
91 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
92 "r24", "r25", "r26/gp", "r27/fp", "r28/sp", "r29/ra",
93 "r30/ea", "r31/ba", "bp0", "bp1", "bp2", "bp3", "wp0",
94 "wp1", "wp2", "wp3"
95};
96
97static inline int zero_extend(unsigned int val, int width)
98{
99 return val & ((1 << width) - 1);
100}
101
102static inline int sign_extend(unsigned int val, int width)
103{
104 int sval;
105
106
107 val <<= 32 - width;
108 sval = val;
109
110 sval >>= 32 - width;
111
112 return sval;
113}
114
115static inline void t_gen_raise_exception(DisasContext *dc, uint32_t index)
116{
117 TCGv_i32 tmp = tcg_const_i32(index);
118
119 gen_helper_raise_exception(cpu_env, tmp);
120 tcg_temp_free_i32(tmp);
121}
122
123static void gen_goto_tb(DisasContext *dc, int n, target_ulong dest)
124{
125 TranslationBlock *tb;
126
127 tb = dc->tb;
128 if ((tb->pc & TARGET_PAGE_MASK) == (dest & TARGET_PAGE_MASK) &&
129 likely(!dc->singlestep_enabled)) {
130 tcg_gen_goto_tb(n);
131 tcg_gen_movi_tl(cpu_pc, dest);
132 tcg_gen_exit_tb((tcg_target_long)tb + n);
133 } else {
134 tcg_gen_movi_tl(cpu_pc, dest);
135 if (dc->singlestep_enabled) {
136 t_gen_raise_exception(dc, EXCP_DEBUG);
137 }
138 tcg_gen_exit_tb(0);
139 }
140}
141
142static void dec_add(DisasContext *dc)
143{
144 if (dc->format == OP_FMT_RI) {
145 if (dc->r0 == R_R0) {
146 if (dc->r1 == R_R0 && dc->imm16 == 0) {
147 LOG_DIS("nop\n");
148 } else {
149 LOG_DIS("mvi r%d, %d\n", dc->r1, sign_extend(dc->imm16, 16));
150 }
151 } else {
152 LOG_DIS("addi r%d, r%d, %d\n", dc->r1, dc->r0,
153 sign_extend(dc->imm16, 16));
154 }
155 } else {
156 LOG_DIS("add r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
157 }
158
159 if (dc->format == OP_FMT_RI) {
160 tcg_gen_addi_tl(cpu_R[dc->r1], cpu_R[dc->r0],
161 sign_extend(dc->imm16, 16));
162 } else {
163 tcg_gen_add_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
164 }
165}
166
167static void dec_and(DisasContext *dc)
168{
169 if (dc->format == OP_FMT_RI) {
170 LOG_DIS("andi r%d, r%d, %d\n", dc->r1, dc->r0,
171 zero_extend(dc->imm16, 16));
172 } else {
173 LOG_DIS("and r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
174 }
175
176 if (dc->format == OP_FMT_RI) {
177 tcg_gen_andi_tl(cpu_R[dc->r1], cpu_R[dc->r0],
178 zero_extend(dc->imm16, 16));
179 } else {
180 if (dc->r0 == 0 && dc->r1 == 0 && dc->r2 == 0) {
181 tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
182 gen_helper_hlt(cpu_env);
183 } else {
184 tcg_gen_and_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
185 }
186 }
187}
188
189static void dec_andhi(DisasContext *dc)
190{
191 LOG_DIS("andhi r%d, r%d, %d\n", dc->r2, dc->r0, dc->imm16);
192
193 tcg_gen_andi_tl(cpu_R[dc->r1], cpu_R[dc->r0], (dc->imm16 << 16));
194}
195
196static void dec_b(DisasContext *dc)
197{
198 if (dc->r0 == R_RA) {
199 LOG_DIS("ret\n");
200 } else if (dc->r0 == R_EA) {
201 LOG_DIS("eret\n");
202 } else if (dc->r0 == R_BA) {
203 LOG_DIS("bret\n");
204 } else {
205 LOG_DIS("b r%d\n", dc->r0);
206 }
207
208
209 if (dc->r0 == R_EA) {
210 TCGv t0 = tcg_temp_new();
211 int l1 = gen_new_label();
212 tcg_gen_andi_tl(t0, cpu_ie, IE_EIE);
213 tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_IE);
214 tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_EIE, l1);
215 tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_IE);
216 gen_set_label(l1);
217 tcg_temp_free(t0);
218 } else if (dc->r0 == R_BA) {
219 TCGv t0 = tcg_temp_new();
220 int l1 = gen_new_label();
221 tcg_gen_andi_tl(t0, cpu_ie, IE_BIE);
222 tcg_gen_ori_tl(cpu_ie, cpu_ie, IE_IE);
223 tcg_gen_brcondi_tl(TCG_COND_EQ, t0, IE_BIE, l1);
224 tcg_gen_andi_tl(cpu_ie, cpu_ie, ~IE_IE);
225 gen_set_label(l1);
226 tcg_temp_free(t0);
227 }
228 tcg_gen_mov_tl(cpu_pc, cpu_R[dc->r0]);
229
230 dc->is_jmp = DISAS_JUMP;
231}
232
233static void dec_bi(DisasContext *dc)
234{
235 LOG_DIS("bi %d\n", sign_extend(dc->imm26 << 2, 26));
236
237 gen_goto_tb(dc, 0, dc->pc + (sign_extend(dc->imm26 << 2, 26)));
238
239 dc->is_jmp = DISAS_TB_JUMP;
240}
241
242static inline void gen_cond_branch(DisasContext *dc, int cond)
243{
244 int l1;
245
246 l1 = gen_new_label();
247 tcg_gen_brcond_tl(cond, cpu_R[dc->r0], cpu_R[dc->r1], l1);
248 gen_goto_tb(dc, 0, dc->pc + 4);
249 gen_set_label(l1);
250 gen_goto_tb(dc, 1, dc->pc + (sign_extend(dc->imm16 << 2, 16)));
251 dc->is_jmp = DISAS_TB_JUMP;
252}
253
254static void dec_be(DisasContext *dc)
255{
256 LOG_DIS("be r%d, r%d, %d\n", dc->r0, dc->r1,
257 sign_extend(dc->imm16, 16) * 4);
258
259 gen_cond_branch(dc, TCG_COND_EQ);
260}
261
262static void dec_bg(DisasContext *dc)
263{
264 LOG_DIS("bg r%d, r%d, %d\n", dc->r0, dc->r1,
265 sign_extend(dc->imm16, 16 * 4));
266
267 gen_cond_branch(dc, TCG_COND_GT);
268}
269
270static void dec_bge(DisasContext *dc)
271{
272 LOG_DIS("bge r%d, r%d, %d\n", dc->r0, dc->r1,
273 sign_extend(dc->imm16, 16) * 4);
274
275 gen_cond_branch(dc, TCG_COND_GE);
276}
277
278static void dec_bgeu(DisasContext *dc)
279{
280 LOG_DIS("bgeu r%d, r%d, %d\n", dc->r0, dc->r1,
281 sign_extend(dc->imm16, 16) * 4);
282
283 gen_cond_branch(dc, TCG_COND_GEU);
284}
285
286static void dec_bgu(DisasContext *dc)
287{
288 LOG_DIS("bgu r%d, r%d, %d\n", dc->r0, dc->r1,
289 sign_extend(dc->imm16, 16) * 4);
290
291 gen_cond_branch(dc, TCG_COND_GTU);
292}
293
294static void dec_bne(DisasContext *dc)
295{
296 LOG_DIS("bne r%d, r%d, %d\n", dc->r0, dc->r1,
297 sign_extend(dc->imm16, 16) * 4);
298
299 gen_cond_branch(dc, TCG_COND_NE);
300}
301
302static void dec_call(DisasContext *dc)
303{
304 LOG_DIS("call r%d\n", dc->r0);
305
306 tcg_gen_movi_tl(cpu_R[R_RA], dc->pc + 4);
307 tcg_gen_mov_tl(cpu_pc, cpu_R[dc->r0]);
308
309 dc->is_jmp = DISAS_JUMP;
310}
311
312static void dec_calli(DisasContext *dc)
313{
314 LOG_DIS("calli %d\n", sign_extend(dc->imm26, 26) * 4);
315
316 tcg_gen_movi_tl(cpu_R[R_RA], dc->pc + 4);
317 gen_goto_tb(dc, 0, dc->pc + (sign_extend(dc->imm26 << 2, 26)));
318
319 dc->is_jmp = DISAS_TB_JUMP;
320}
321
322static inline void gen_compare(DisasContext *dc, int cond)
323{
324 int rX = (dc->format == OP_FMT_RR) ? dc->r2 : dc->r1;
325 int rY = (dc->format == OP_FMT_RR) ? dc->r0 : dc->r0;
326 int rZ = (dc->format == OP_FMT_RR) ? dc->r1 : -1;
327
328 if (dc->format == OP_FMT_RI) {
329 tcg_gen_setcondi_tl(cond, cpu_R[rX], cpu_R[rY],
330 sign_extend(dc->imm16, 16));
331 } else {
332 tcg_gen_setcond_tl(cond, cpu_R[rX], cpu_R[rY], cpu_R[rZ]);
333 }
334}
335
336static void dec_cmpe(DisasContext *dc)
337{
338 if (dc->format == OP_FMT_RI) {
339 LOG_DIS("cmpei r%d, r%d, %d\n", dc->r0, dc->r1,
340 sign_extend(dc->imm16, 16));
341 } else {
342 LOG_DIS("cmpe r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
343 }
344
345 gen_compare(dc, TCG_COND_EQ);
346}
347
348static void dec_cmpg(DisasContext *dc)
349{
350 if (dc->format == OP_FMT_RI) {
351 LOG_DIS("cmpgi r%d, r%d, %d\n", dc->r0, dc->r1,
352 sign_extend(dc->imm16, 16));
353 } else {
354 LOG_DIS("cmpg r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
355 }
356
357 gen_compare(dc, TCG_COND_GT);
358}
359
360static void dec_cmpge(DisasContext *dc)
361{
362 if (dc->format == OP_FMT_RI) {
363 LOG_DIS("cmpgei r%d, r%d, %d\n", dc->r0, dc->r1,
364 sign_extend(dc->imm16, 16));
365 } else {
366 LOG_DIS("cmpge r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
367 }
368
369 gen_compare(dc, TCG_COND_GE);
370}
371
372static void dec_cmpgeu(DisasContext *dc)
373{
374 if (dc->format == OP_FMT_RI) {
375 LOG_DIS("cmpgeui r%d, r%d, %d\n", dc->r0, dc->r1,
376 sign_extend(dc->imm16, 16));
377 } else {
378 LOG_DIS("cmpgeu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
379 }
380
381 gen_compare(dc, TCG_COND_GEU);
382}
383
384static void dec_cmpgu(DisasContext *dc)
385{
386 if (dc->format == OP_FMT_RI) {
387 LOG_DIS("cmpgui r%d, r%d, %d\n", dc->r0, dc->r1,
388 sign_extend(dc->imm16, 16));
389 } else {
390 LOG_DIS("cmpgu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
391 }
392
393 gen_compare(dc, TCG_COND_GTU);
394}
395
396static void dec_cmpne(DisasContext *dc)
397{
398 if (dc->format == OP_FMT_RI) {
399 LOG_DIS("cmpnei r%d, r%d, %d\n", dc->r0, dc->r1,
400 sign_extend(dc->imm16, 16));
401 } else {
402 LOG_DIS("cmpne r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
403 }
404
405 gen_compare(dc, TCG_COND_NE);
406}
407
408static void dec_divu(DisasContext *dc)
409{
410 int l1;
411
412 LOG_DIS("divu r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
413
414 if (!(dc->env->features & LM32_FEATURE_DIVIDE)) {
415 cpu_abort(dc->env, "hardware divider is not available\n");
416 }
417
418 l1 = gen_new_label();
419 tcg_gen_brcondi_tl(TCG_COND_NE, cpu_R[dc->r1], 0, l1);
420 tcg_gen_movi_tl(cpu_pc, dc->pc);
421 t_gen_raise_exception(dc, EXCP_DIVIDE_BY_ZERO);
422 gen_set_label(l1);
423 tcg_gen_divu_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
424}
425
426static void dec_lb(DisasContext *dc)
427{
428 TCGv t0;
429
430 LOG_DIS("lb r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
431
432 t0 = tcg_temp_new();
433 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
434 tcg_gen_qemu_ld8s(cpu_R[dc->r1], t0, MEM_INDEX);
435 tcg_temp_free(t0);
436}
437
438static void dec_lbu(DisasContext *dc)
439{
440 TCGv t0;
441
442 LOG_DIS("lbu r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
443
444 t0 = tcg_temp_new();
445 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
446 tcg_gen_qemu_ld8u(cpu_R[dc->r1], t0, MEM_INDEX);
447 tcg_temp_free(t0);
448}
449
450static void dec_lh(DisasContext *dc)
451{
452 TCGv t0;
453
454 LOG_DIS("lh r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
455
456 t0 = tcg_temp_new();
457 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
458 tcg_gen_qemu_ld16s(cpu_R[dc->r1], t0, MEM_INDEX);
459 tcg_temp_free(t0);
460}
461
462static void dec_lhu(DisasContext *dc)
463{
464 TCGv t0;
465
466 LOG_DIS("lhu r%d, (r%d+%d)\n", dc->r1, dc->r0, dc->imm16);
467
468 t0 = tcg_temp_new();
469 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
470 tcg_gen_qemu_ld16u(cpu_R[dc->r1], t0, MEM_INDEX);
471 tcg_temp_free(t0);
472}
473
474static void dec_lw(DisasContext *dc)
475{
476 TCGv t0;
477
478 LOG_DIS("lw r%d, (r%d+%d)\n", dc->r1, dc->r0, sign_extend(dc->imm16, 16));
479
480 t0 = tcg_temp_new();
481 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
482 tcg_gen_qemu_ld32s(cpu_R[dc->r1], t0, MEM_INDEX);
483 tcg_temp_free(t0);
484}
485
486static void dec_modu(DisasContext *dc)
487{
488 int l1;
489
490 LOG_DIS("modu r%d, r%d, %d\n", dc->r2, dc->r0, dc->r1);
491
492 if (!(dc->env->features & LM32_FEATURE_DIVIDE)) {
493 cpu_abort(dc->env, "hardware divider is not available\n");
494 }
495
496 l1 = gen_new_label();
497 tcg_gen_brcondi_tl(TCG_COND_NE, cpu_R[dc->r1], 0, l1);
498 tcg_gen_movi_tl(cpu_pc, dc->pc);
499 t_gen_raise_exception(dc, EXCP_DIVIDE_BY_ZERO);
500 gen_set_label(l1);
501 tcg_gen_remu_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
502}
503
504static void dec_mul(DisasContext *dc)
505{
506 if (dc->format == OP_FMT_RI) {
507 LOG_DIS("muli r%d, r%d, %d\n", dc->r0, dc->r1,
508 sign_extend(dc->imm16, 16));
509 } else {
510 LOG_DIS("mul r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
511 }
512
513 if (!(dc->env->features & LM32_FEATURE_MULTIPLY)) {
514 cpu_abort(dc->env, "hardware multiplier is not available\n");
515 }
516
517 if (dc->format == OP_FMT_RI) {
518 tcg_gen_muli_tl(cpu_R[dc->r1], cpu_R[dc->r0],
519 sign_extend(dc->imm16, 16));
520 } else {
521 tcg_gen_mul_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
522 }
523}
524
525static void dec_nor(DisasContext *dc)
526{
527 if (dc->format == OP_FMT_RI) {
528 LOG_DIS("nori r%d, r%d, %d\n", dc->r0, dc->r1,
529 zero_extend(dc->imm16, 16));
530 } else {
531 LOG_DIS("nor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
532 }
533
534 if (dc->format == OP_FMT_RI) {
535 TCGv t0 = tcg_temp_new();
536 tcg_gen_movi_tl(t0, zero_extend(dc->imm16, 16));
537 tcg_gen_nor_tl(cpu_R[dc->r1], cpu_R[dc->r0], t0);
538 tcg_temp_free(t0);
539 } else {
540 tcg_gen_nor_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
541 }
542}
543
544static void dec_or(DisasContext *dc)
545{
546 if (dc->format == OP_FMT_RI) {
547 LOG_DIS("ori r%d, r%d, %d\n", dc->r1, dc->r0,
548 zero_extend(dc->imm16, 16));
549 } else {
550 if (dc->r1 == R_R0) {
551 LOG_DIS("mv r%d, r%d\n", dc->r2, dc->r0);
552 } else {
553 LOG_DIS("or r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
554 }
555 }
556
557 if (dc->format == OP_FMT_RI) {
558 tcg_gen_ori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
559 zero_extend(dc->imm16, 16));
560 } else {
561 tcg_gen_or_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
562 }
563}
564
565static void dec_orhi(DisasContext *dc)
566{
567 if (dc->r0 == R_R0) {
568 LOG_DIS("mvhi r%d, %d\n", dc->r1, dc->imm16);
569 } else {
570 LOG_DIS("orhi r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm16);
571 }
572
573 tcg_gen_ori_tl(cpu_R[dc->r1], cpu_R[dc->r0], (dc->imm16 << 16));
574}
575
576static void dec_scall(DisasContext *dc)
577{
578 if (dc->imm5 == 7) {
579 LOG_DIS("scall\n");
580 } else if (dc->imm5 == 2) {
581 LOG_DIS("break\n");
582 } else {
583 cpu_abort(dc->env, "invalid opcode\n");
584 }
585
586 if (dc->imm5 == 7) {
587 tcg_gen_movi_tl(cpu_pc, dc->pc);
588 t_gen_raise_exception(dc, EXCP_SYSTEMCALL);
589 } else {
590 tcg_gen_movi_tl(cpu_pc, dc->pc);
591 t_gen_raise_exception(dc, EXCP_BREAKPOINT);
592 }
593}
594
595static void dec_rcsr(DisasContext *dc)
596{
597 LOG_DIS("rcsr r%d, %d\n", dc->r2, dc->csr);
598
599 switch (dc->csr) {
600 case CSR_IE:
601 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_ie);
602 break;
603 case CSR_IM:
604 gen_helper_rcsr_im(cpu_R[dc->r2], cpu_env);
605 break;
606 case CSR_IP:
607 gen_helper_rcsr_ip(cpu_R[dc->r2], cpu_env);
608 break;
609 case CSR_CC:
610 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_cc);
611 break;
612 case CSR_CFG:
613 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_cfg);
614 break;
615 case CSR_EBA:
616 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_eba);
617 break;
618 case CSR_DC:
619 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_dc);
620 break;
621 case CSR_DEBA:
622 tcg_gen_mov_tl(cpu_R[dc->r2], cpu_deba);
623 break;
624 case CSR_JTX:
625 gen_helper_rcsr_jtx(cpu_R[dc->r2], cpu_env);
626 break;
627 case CSR_JRX:
628 gen_helper_rcsr_jrx(cpu_R[dc->r2], cpu_env);
629 break;
630 case CSR_ICC:
631 case CSR_DCC:
632 case CSR_BP0:
633 case CSR_BP1:
634 case CSR_BP2:
635 case CSR_BP3:
636 case CSR_WP0:
637 case CSR_WP1:
638 case CSR_WP2:
639 case CSR_WP3:
640 cpu_abort(dc->env, "invalid read access csr=%x\n", dc->csr);
641 break;
642 default:
643 cpu_abort(dc->env, "read_csr: unknown csr=%x\n", dc->csr);
644 break;
645 }
646}
647
648static void dec_sb(DisasContext *dc)
649{
650 TCGv t0;
651
652 LOG_DIS("sb (r%d+%d), r%d\n", dc->r0, dc->imm16, dc->r1);
653
654 t0 = tcg_temp_new();
655 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
656 tcg_gen_qemu_st8(cpu_R[dc->r1], t0, MEM_INDEX);
657 tcg_temp_free(t0);
658}
659
660static void dec_sextb(DisasContext *dc)
661{
662 LOG_DIS("sextb r%d, r%d\n", dc->r2, dc->r0);
663
664 if (!(dc->env->features & LM32_FEATURE_SIGN_EXTEND)) {
665 cpu_abort(dc->env, "hardware sign extender is not available\n");
666 }
667
668 tcg_gen_ext8s_tl(cpu_R[dc->r2], cpu_R[dc->r0]);
669}
670
671static void dec_sexth(DisasContext *dc)
672{
673 LOG_DIS("sexth r%d, r%d\n", dc->r2, dc->r0);
674
675 if (!(dc->env->features & LM32_FEATURE_SIGN_EXTEND)) {
676 cpu_abort(dc->env, "hardware sign extender is not available\n");
677 }
678
679 tcg_gen_ext16s_tl(cpu_R[dc->r2], cpu_R[dc->r0]);
680}
681
682static void dec_sh(DisasContext *dc)
683{
684 TCGv t0;
685
686 LOG_DIS("sh (r%d+%d), r%d\n", dc->r0, dc->imm16, dc->r1);
687
688 t0 = tcg_temp_new();
689 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
690 tcg_gen_qemu_st16(cpu_R[dc->r1], t0, MEM_INDEX);
691 tcg_temp_free(t0);
692}
693
694static void dec_sl(DisasContext *dc)
695{
696 if (dc->format == OP_FMT_RI) {
697 LOG_DIS("sli r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
698 } else {
699 LOG_DIS("sl r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
700 }
701
702 if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
703 cpu_abort(dc->env, "hardware shifter is not available\n");
704 }
705
706 if (dc->format == OP_FMT_RI) {
707 tcg_gen_shli_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
708 } else {
709 TCGv t0 = tcg_temp_new();
710 tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
711 tcg_gen_shl_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
712 tcg_temp_free(t0);
713 }
714}
715
716static void dec_sr(DisasContext *dc)
717{
718 if (dc->format == OP_FMT_RI) {
719 LOG_DIS("sri r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
720 } else {
721 LOG_DIS("sr r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
722 }
723
724 if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
725 if (dc->format == OP_FMT_RI) {
726
727 } else {
728 if (dc->imm5 != 1) {
729 cpu_abort(dc->env, "hardware shifter is not available\n");
730 }
731 }
732 }
733
734 if (dc->format == OP_FMT_RI) {
735 tcg_gen_sari_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
736 } else {
737 TCGv t0 = tcg_temp_new();
738 tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
739 tcg_gen_sar_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
740 tcg_temp_free(t0);
741 }
742}
743
744static void dec_sru(DisasContext *dc)
745{
746 if (dc->format == OP_FMT_RI) {
747 LOG_DIS("srui r%d, r%d, %d\n", dc->r1, dc->r0, dc->imm5);
748 } else {
749 LOG_DIS("sru r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
750 }
751
752 if (!(dc->env->features & LM32_FEATURE_SHIFT)) {
753 if (dc->format == OP_FMT_RI) {
754
755 } else {
756 if (dc->imm5 != 1) {
757 cpu_abort(dc->env, "hardware shifter is not available\n");
758 }
759 }
760 }
761
762 if (dc->format == OP_FMT_RI) {
763 tcg_gen_shri_tl(cpu_R[dc->r1], cpu_R[dc->r0], dc->imm5);
764 } else {
765 TCGv t0 = tcg_temp_new();
766 tcg_gen_andi_tl(t0, cpu_R[dc->r1], 0x1f);
767 tcg_gen_shr_tl(cpu_R[dc->r2], cpu_R[dc->r0], t0);
768 tcg_temp_free(t0);
769 }
770}
771
772static void dec_sub(DisasContext *dc)
773{
774 LOG_DIS("sub r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
775
776 tcg_gen_sub_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
777}
778
779static void dec_sw(DisasContext *dc)
780{
781 TCGv t0;
782
783 LOG_DIS("sw (r%d+%d), r%d\n", dc->r0, sign_extend(dc->imm16, 16), dc->r1);
784
785 t0 = tcg_temp_new();
786 tcg_gen_addi_tl(t0, cpu_R[dc->r0], sign_extend(dc->imm16, 16));
787 tcg_gen_qemu_st32(cpu_R[dc->r1], t0, MEM_INDEX);
788 tcg_temp_free(t0);
789}
790
791static void dec_user(DisasContext *dc)
792{
793 LOG_DIS("user");
794
795 cpu_abort(dc->env, "user insn undefined\n");
796}
797
798static void dec_wcsr(DisasContext *dc)
799{
800 int no;
801
802 LOG_DIS("wcsr r%d, %d\n", dc->r1, dc->csr);
803
804 switch (dc->csr) {
805 case CSR_IE:
806 tcg_gen_mov_tl(cpu_ie, cpu_R[dc->r1]);
807 tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
808 dc->is_jmp = DISAS_UPDATE;
809 break;
810 case CSR_IM:
811
812 if (use_icount) {
813 gen_io_start();
814 }
815 gen_helper_wcsr_im(cpu_env, cpu_R[dc->r1]);
816 tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
817 if (use_icount) {
818 gen_io_end();
819 }
820 dc->is_jmp = DISAS_UPDATE;
821 break;
822 case CSR_IP:
823
824 if (use_icount) {
825 gen_io_start();
826 }
827 gen_helper_wcsr_ip(cpu_env, cpu_R[dc->r1]);
828 tcg_gen_movi_tl(cpu_pc, dc->pc + 4);
829 if (use_icount) {
830 gen_io_end();
831 }
832 dc->is_jmp = DISAS_UPDATE;
833 break;
834 case CSR_ICC:
835
836 break;
837 case CSR_DCC:
838
839 break;
840 case CSR_EBA:
841 tcg_gen_mov_tl(cpu_eba, cpu_R[dc->r1]);
842 break;
843 case CSR_DEBA:
844 tcg_gen_mov_tl(cpu_deba, cpu_R[dc->r1]);
845 break;
846 case CSR_JTX:
847 gen_helper_wcsr_jtx(cpu_env, cpu_R[dc->r1]);
848 break;
849 case CSR_JRX:
850 gen_helper_wcsr_jrx(cpu_env, cpu_R[dc->r1]);
851 break;
852 case CSR_DC:
853 tcg_gen_mov_tl(cpu_dc, cpu_R[dc->r1]);
854 break;
855 case CSR_BP0:
856 case CSR_BP1:
857 case CSR_BP2:
858 case CSR_BP3:
859 no = dc->csr - CSR_BP0;
860 if (dc->env->num_bps <= no) {
861 cpu_abort(dc->env, "breakpoint #%i is not available\n", no);
862 }
863 tcg_gen_mov_tl(cpu_bp[no], cpu_R[dc->r1]);
864 break;
865 case CSR_WP0:
866 case CSR_WP1:
867 case CSR_WP2:
868 case CSR_WP3:
869 no = dc->csr - CSR_WP0;
870 if (dc->env->num_wps <= no) {
871 cpu_abort(dc->env, "watchpoint #%i is not available\n", no);
872 }
873 tcg_gen_mov_tl(cpu_wp[no], cpu_R[dc->r1]);
874 break;
875 case CSR_CC:
876 case CSR_CFG:
877 cpu_abort(dc->env, "invalid write access csr=%x\n", dc->csr);
878 break;
879 default:
880 cpu_abort(dc->env, "write_csr unknown csr=%x\n", dc->csr);
881 break;
882 }
883}
884
885static void dec_xnor(DisasContext *dc)
886{
887 if (dc->format == OP_FMT_RI) {
888 LOG_DIS("xnori r%d, r%d, %d\n", dc->r0, dc->r1,
889 zero_extend(dc->imm16, 16));
890 } else {
891 if (dc->r1 == R_R0) {
892 LOG_DIS("not r%d, r%d\n", dc->r2, dc->r0);
893 } else {
894 LOG_DIS("xnor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
895 }
896 }
897
898 if (dc->format == OP_FMT_RI) {
899 tcg_gen_xori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
900 zero_extend(dc->imm16, 16));
901 tcg_gen_not_tl(cpu_R[dc->r1], cpu_R[dc->r1]);
902 } else {
903 tcg_gen_eqv_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
904 }
905}
906
907static void dec_xor(DisasContext *dc)
908{
909 if (dc->format == OP_FMT_RI) {
910 LOG_DIS("xori r%d, r%d, %d\n", dc->r0, dc->r1,
911 zero_extend(dc->imm16, 16));
912 } else {
913 LOG_DIS("xor r%d, r%d, r%d\n", dc->r2, dc->r0, dc->r1);
914 }
915
916 if (dc->format == OP_FMT_RI) {
917 tcg_gen_xori_tl(cpu_R[dc->r1], cpu_R[dc->r0],
918 zero_extend(dc->imm16, 16));
919 } else {
920 tcg_gen_xor_tl(cpu_R[dc->r2], cpu_R[dc->r0], cpu_R[dc->r1]);
921 }
922}
923
924static void dec_ill(DisasContext *dc)
925{
926 cpu_abort(dc->env, "unknown opcode 0x%02x\n", dc->opcode);
927}
928
929typedef void (*DecoderInfo)(DisasContext *dc);
930static const DecoderInfo decinfo[] = {
931 dec_sru, dec_nor, dec_mul, dec_sh, dec_lb, dec_sr, dec_xor, dec_lh,
932 dec_and, dec_xnor, dec_lw, dec_lhu, dec_sb, dec_add, dec_or, dec_sl,
933 dec_lbu, dec_be, dec_bg, dec_bge, dec_bgeu, dec_bgu, dec_sw, dec_bne,
934 dec_andhi, dec_cmpe, dec_cmpg, dec_cmpge, dec_cmpgeu, dec_cmpgu, dec_orhi,
935 dec_cmpne,
936 dec_sru, dec_nor, dec_mul, dec_divu, dec_rcsr, dec_sr, dec_xor, dec_ill,
937 dec_and, dec_xnor, dec_ill, dec_scall, dec_sextb, dec_add, dec_or, dec_sl,
938 dec_b, dec_modu, dec_sub, dec_user, dec_wcsr, dec_ill, dec_call, dec_sexth,
939 dec_bi, dec_cmpe, dec_cmpg, dec_cmpge, dec_cmpgeu, dec_cmpgu, dec_calli,
940 dec_cmpne
941};
942
943static inline void decode(DisasContext *dc, uint32_t ir)
944{
945 if (unlikely(qemu_loglevel_mask(CPU_LOG_TB_OP | CPU_LOG_TB_OP_OPT))) {
946 tcg_gen_debug_insn_start(dc->pc);
947 }
948
949 dc->ir = ir;
950 LOG_DIS("%8.8x\t", dc->ir);
951
952
953
954 if (dc->ir) {
955 dc->nr_nops = 0;
956 } else {
957 LOG_DIS("nr_nops=%d\t", dc->nr_nops);
958 dc->nr_nops++;
959 if (dc->nr_nops > 4) {
960 cpu_abort(dc->env, "fetching nop sequence\n");
961 }
962 }
963
964 dc->opcode = EXTRACT_FIELD(ir, 26, 31);
965
966 dc->imm5 = EXTRACT_FIELD(ir, 0, 4);
967 dc->imm16 = EXTRACT_FIELD(ir, 0, 15);
968 dc->imm26 = EXTRACT_FIELD(ir, 0, 25);
969
970 dc->csr = EXTRACT_FIELD(ir, 21, 25);
971 dc->r0 = EXTRACT_FIELD(ir, 21, 25);
972 dc->r1 = EXTRACT_FIELD(ir, 16, 20);
973 dc->r2 = EXTRACT_FIELD(ir, 11, 15);
974
975
976 if (ir & (1 << 31)) {
977 dc->format = OP_FMT_RR;
978 } else {
979 dc->format = OP_FMT_RI;
980 }
981
982 assert(ARRAY_SIZE(decinfo) == 64);
983 assert(dc->opcode < 64);
984
985 decinfo[dc->opcode](dc);
986}
987
988static void check_breakpoint(CPULM32State *env, DisasContext *dc)
989{
990 CPUBreakpoint *bp;
991
992 if (unlikely(!QTAILQ_EMPTY(&env->breakpoints))) {
993 QTAILQ_FOREACH(bp, &env->breakpoints, entry) {
994 if (bp->pc == dc->pc) {
995 tcg_gen_movi_tl(cpu_pc, dc->pc);
996 t_gen_raise_exception(dc, EXCP_DEBUG);
997 dc->is_jmp = DISAS_UPDATE;
998 }
999 }
1000 }
1001}
1002
1003
1004static void gen_intermediate_code_internal(CPULM32State *env,
1005 TranslationBlock *tb, int search_pc)
1006{
1007 struct DisasContext ctx, *dc = &ctx;
1008 uint16_t *gen_opc_end;
1009 uint32_t pc_start;
1010 int j, lj;
1011 uint32_t next_page_start;
1012 int num_insns;
1013 int max_insns;
1014
1015 qemu_log_try_set_file(stderr);
1016
1017 pc_start = tb->pc;
1018 dc->env = env;
1019 dc->tb = tb;
1020
1021 gen_opc_end = tcg_ctx.gen_opc_buf + OPC_MAX_SIZE;
1022
1023 dc->is_jmp = DISAS_NEXT;
1024 dc->pc = pc_start;
1025 dc->singlestep_enabled = env->singlestep_enabled;
1026 dc->nr_nops = 0;
1027
1028 if (pc_start & 3) {
1029 cpu_abort(env, "LM32: unaligned PC=%x\n", pc_start);
1030 }
1031
1032 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1033 qemu_log("-----------------------------------------\n");
1034 log_cpu_state(env, 0);
1035 }
1036
1037 next_page_start = (pc_start & TARGET_PAGE_MASK) + TARGET_PAGE_SIZE;
1038 lj = -1;
1039 num_insns = 0;
1040 max_insns = tb->cflags & CF_COUNT_MASK;
1041 if (max_insns == 0) {
1042 max_insns = CF_COUNT_MASK;
1043 }
1044
1045 gen_icount_start();
1046 do {
1047 check_breakpoint(env, dc);
1048
1049 if (search_pc) {
1050 j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
1051 if (lj < j) {
1052 lj++;
1053 while (lj < j) {
1054 tcg_ctx.gen_opc_instr_start[lj++] = 0;
1055 }
1056 }
1057 tcg_ctx.gen_opc_pc[lj] = dc->pc;
1058 tcg_ctx.gen_opc_instr_start[lj] = 1;
1059 tcg_ctx.gen_opc_icount[lj] = num_insns;
1060 }
1061
1062
1063 LOG_DIS("%8.8x:\t", dc->pc);
1064
1065 if (num_insns + 1 == max_insns && (tb->cflags & CF_LAST_IO)) {
1066 gen_io_start();
1067 }
1068
1069 decode(dc, cpu_ldl_code(env, dc->pc));
1070 dc->pc += 4;
1071 num_insns++;
1072
1073 } while (!dc->is_jmp
1074 && tcg_ctx.gen_opc_ptr < gen_opc_end
1075 && !env->singlestep_enabled
1076 && !singlestep
1077 && (dc->pc < next_page_start)
1078 && num_insns < max_insns);
1079
1080 if (tb->cflags & CF_LAST_IO) {
1081 gen_io_end();
1082 }
1083
1084 if (unlikely(env->singlestep_enabled)) {
1085 if (dc->is_jmp == DISAS_NEXT) {
1086 tcg_gen_movi_tl(cpu_pc, dc->pc);
1087 }
1088 t_gen_raise_exception(dc, EXCP_DEBUG);
1089 } else {
1090 switch (dc->is_jmp) {
1091 case DISAS_NEXT:
1092 gen_goto_tb(dc, 1, dc->pc);
1093 break;
1094 default:
1095 case DISAS_JUMP:
1096 case DISAS_UPDATE:
1097
1098
1099 tcg_gen_exit_tb(0);
1100 break;
1101 case DISAS_TB_JUMP:
1102
1103 break;
1104 }
1105 }
1106
1107 gen_icount_end(tb, num_insns);
1108 *tcg_ctx.gen_opc_ptr = INDEX_op_end;
1109 if (search_pc) {
1110 j = tcg_ctx.gen_opc_ptr - tcg_ctx.gen_opc_buf;
1111 lj++;
1112 while (lj <= j) {
1113 tcg_ctx.gen_opc_instr_start[lj++] = 0;
1114 }
1115 } else {
1116 tb->size = dc->pc - pc_start;
1117 tb->icount = num_insns;
1118 }
1119
1120#ifdef DEBUG_DISAS
1121 if (qemu_loglevel_mask(CPU_LOG_TB_IN_ASM)) {
1122 qemu_log("\n");
1123 log_target_disas(env, pc_start, dc->pc - pc_start, 0);
1124 qemu_log("\nisize=%d osize=%td\n",
1125 dc->pc - pc_start, tcg_ctx.gen_opc_ptr -
1126 tcg_ctx.gen_opc_buf);
1127 }
1128#endif
1129}
1130
1131void gen_intermediate_code(CPULM32State *env, struct TranslationBlock *tb)
1132{
1133 gen_intermediate_code_internal(env, tb, 0);
1134}
1135
1136void gen_intermediate_code_pc(CPULM32State *env, struct TranslationBlock *tb)
1137{
1138 gen_intermediate_code_internal(env, tb, 1);
1139}
1140
1141void cpu_dump_state(CPULM32State *env, FILE *f, fprintf_function cpu_fprintf,
1142 int flags)
1143{
1144 int i;
1145
1146 if (!env || !f) {
1147 return;
1148 }
1149
1150 cpu_fprintf(f, "IN: PC=%x %s\n",
1151 env->pc, lookup_symbol(env->pc));
1152
1153 cpu_fprintf(f, "ie=%8.8x (IE=%x EIE=%x BIE=%x) im=%8.8x ip=%8.8x\n",
1154 env->ie,
1155 (env->ie & IE_IE) ? 1 : 0,
1156 (env->ie & IE_EIE) ? 1 : 0,
1157 (env->ie & IE_BIE) ? 1 : 0,
1158 lm32_pic_get_im(env->pic_state),
1159 lm32_pic_get_ip(env->pic_state));
1160 cpu_fprintf(f, "eba=%8.8x deba=%8.8x\n",
1161 env->eba,
1162 env->deba);
1163
1164 for (i = 0; i < 32; i++) {
1165 cpu_fprintf(f, "r%2.2d=%8.8x ", i, env->regs[i]);
1166 if ((i + 1) % 4 == 0) {
1167 cpu_fprintf(f, "\n");
1168 }
1169 }
1170 cpu_fprintf(f, "\n\n");
1171}
1172
1173void restore_state_to_opc(CPULM32State *env, TranslationBlock *tb, int pc_pos)
1174{
1175 env->pc = tcg_ctx.gen_opc_pc[pc_pos];
1176}
1177
1178void lm32_translate_init(void)
1179{
1180 int i;
1181
1182 cpu_env = tcg_global_reg_new_ptr(TCG_AREG0, "env");
1183
1184 for (i = 0; i < ARRAY_SIZE(cpu_R); i++) {
1185 cpu_R[i] = tcg_global_mem_new(TCG_AREG0,
1186 offsetof(CPULM32State, regs[i]),
1187 regnames[i]);
1188 }
1189
1190 for (i = 0; i < ARRAY_SIZE(cpu_bp); i++) {
1191 cpu_bp[i] = tcg_global_mem_new(TCG_AREG0,
1192 offsetof(CPULM32State, bp[i]),
1193 regnames[32+i]);
1194 }
1195
1196 for (i = 0; i < ARRAY_SIZE(cpu_wp); i++) {
1197 cpu_wp[i] = tcg_global_mem_new(TCG_AREG0,
1198 offsetof(CPULM32State, wp[i]),
1199 regnames[36+i]);
1200 }
1201
1202 cpu_pc = tcg_global_mem_new(TCG_AREG0,
1203 offsetof(CPULM32State, pc),
1204 "pc");
1205 cpu_ie = tcg_global_mem_new(TCG_AREG0,
1206 offsetof(CPULM32State, ie),
1207 "ie");
1208 cpu_icc = tcg_global_mem_new(TCG_AREG0,
1209 offsetof(CPULM32State, icc),
1210 "icc");
1211 cpu_dcc = tcg_global_mem_new(TCG_AREG0,
1212 offsetof(CPULM32State, dcc),
1213 "dcc");
1214 cpu_cc = tcg_global_mem_new(TCG_AREG0,
1215 offsetof(CPULM32State, cc),
1216 "cc");
1217 cpu_cfg = tcg_global_mem_new(TCG_AREG0,
1218 offsetof(CPULM32State, cfg),
1219 "cfg");
1220 cpu_eba = tcg_global_mem_new(TCG_AREG0,
1221 offsetof(CPULM32State, eba),
1222 "eba");
1223 cpu_dc = tcg_global_mem_new(TCG_AREG0,
1224 offsetof(CPULM32State, dc),
1225 "dc");
1226 cpu_deba = tcg_global_mem_new(TCG_AREG0,
1227 offsetof(CPULM32State, deba),
1228 "deba");
1229}
1230
1231
