4 * Copyright (c) 2003 Fabrice Bellard
5 * Copyright (c) 2005 CodeSourcery, LLC
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
31 /* internal defines */
32 typedef struct DisasContext {
35 struct TranslationBlock *tb;
38 #define DISAS_JUMP_NEXT 4
40 /* XXX: move that elsewhere */
41 static uint16_t *gen_opc_ptr;
42 static uint32_t *gen_opparam_ptr;
47 #define DEF(s, n, copy_size) INDEX_op_ ## s,
55 static GenOpFunc2 *gen_test_cc[14] = {
72 const uint8_t table_logic_cc[16] = {
91 static GenOpFunc1 *gen_shift_T1_im[4] = {
98 static GenOpFunc *gen_shift_T1_0[4] = {
105 static GenOpFunc1 *gen_shift_T2_im[4] = {
112 static GenOpFunc *gen_shift_T2_0[4] = {
119 static GenOpFunc1 *gen_shift_T1_im_cc[4] = {
120 gen_op_shll_T1_im_cc,
121 gen_op_shrl_T1_im_cc,
122 gen_op_sarl_T1_im_cc,
123 gen_op_rorl_T1_im_cc,
126 static GenOpFunc *gen_shift_T1_0_cc[4] = {
133 static GenOpFunc *gen_shift_T1_T0[4] = {
140 static GenOpFunc *gen_shift_T1_T0_cc[4] = {
141 gen_op_shll_T1_T0_cc,
142 gen_op_shrl_T1_T0_cc,
143 gen_op_sarl_T1_T0_cc,
144 gen_op_rorl_T1_T0_cc,
147 static GenOpFunc *gen_op_movl_TN_reg[3][16] = {
204 static GenOpFunc *gen_op_movl_reg_TN[2][16] = {
243 static GenOpFunc1 *gen_op_movl_TN_im[3] = {
249 static GenOpFunc1 *gen_shift_T0_im_thumb[3] = {
250 gen_op_shll_T0_im_thumb,
251 gen_op_shrl_T0_im_thumb,
252 gen_op_sarl_T0_im_thumb,
255 static inline void gen_bx(DisasContext *s)
257 s->is_jmp = DISAS_UPDATE;
261 static inline void gen_movl_TN_reg(DisasContext *s, int reg, int t)
266 /* normaly, since we updated PC, we need only to add 4 */
267 val = (long)s->pc + 4;
268 gen_op_movl_TN_im[t](val);
270 gen_op_movl_TN_reg[t][reg]();
274 static inline void gen_movl_T0_reg(DisasContext *s, int reg)
276 gen_movl_TN_reg(s, reg, 0);
279 static inline void gen_movl_T1_reg(DisasContext *s, int reg)
281 gen_movl_TN_reg(s, reg, 1);
284 static inline void gen_movl_T2_reg(DisasContext *s, int reg)
286 gen_movl_TN_reg(s, reg, 2);
289 static inline void gen_movl_reg_TN(DisasContext *s, int reg, int t)
291 gen_op_movl_reg_TN[t][reg]();
293 s->is_jmp = DISAS_JUMP;
297 static inline void gen_movl_reg_T0(DisasContext *s, int reg)
299 gen_movl_reg_TN(s, reg, 0);
302 static inline void gen_movl_reg_T1(DisasContext *s, int reg)
304 gen_movl_reg_TN(s, reg, 1);
307 static inline void gen_add_data_offset(DisasContext *s, unsigned int insn)
309 int val, rm, shift, shiftop;
311 if (!(insn & (1 << 25))) {
314 if (!(insn & (1 << 23)))
317 gen_op_addl_T1_im(val);
321 shift = (insn >> 7) & 0x1f;
322 gen_movl_T2_reg(s, rm);
323 shiftop = (insn >> 5) & 3;
325 gen_shift_T2_im[shiftop](shift);
326 } else if (shiftop != 0) {
327 gen_shift_T2_0[shiftop]();
329 if (!(insn & (1 << 23)))
336 static inline void gen_add_datah_offset(DisasContext *s, unsigned int insn)
340 if (insn & (1 << 22)) {
342 val = (insn & 0xf) | ((insn >> 4) & 0xf0);
343 if (!(insn & (1 << 23)))
346 gen_op_addl_T1_im(val);
350 gen_movl_T2_reg(s, rm);
351 if (!(insn & (1 << 23)))
358 #define VFP_OP(name) \
359 static inline void gen_vfp_##name(int dp) \
362 gen_op_vfp_##name##d(); \
364 gen_op_vfp_##name##s(); \
389 vfp_reg_offset (int dp, int reg)
392 return offsetof(CPUARMState, vfp.regs[reg]);
394 return offsetof(CPUARMState, vfp.regs[reg >> 1])
395 + offsetof(CPU_DoubleU, l.upper);
397 return offsetof(CPUARMState, vfp.regs[reg >> 1])
398 + offsetof(CPU_DoubleU, l.lower);
401 static inline void gen_mov_F0_vreg(int dp, int reg)
404 gen_op_vfp_getreg_F0d(vfp_reg_offset(dp, reg));
406 gen_op_vfp_getreg_F0s(vfp_reg_offset(dp, reg));
409 static inline void gen_mov_F1_vreg(int dp, int reg)
412 gen_op_vfp_getreg_F1d(vfp_reg_offset(dp, reg));
414 gen_op_vfp_getreg_F1s(vfp_reg_offset(dp, reg));
417 static inline void gen_mov_vreg_F0(int dp, int reg)
420 gen_op_vfp_setreg_F0d(vfp_reg_offset(dp, reg));
422 gen_op_vfp_setreg_F0s(vfp_reg_offset(dp, reg));
425 /* Disassemble a VFP instruction. Returns nonzero if an error occured
426 (ie. an undefined instruction). */
427 static int disas_vfp_insn(CPUState * env, DisasContext *s, uint32_t insn)
429 uint32_t rd, rn, rm, op, i, n, offset, delta_d, delta_m, bank_mask;
432 dp = ((insn & 0xf00) == 0xb00);
433 switch ((insn >> 24) & 0xf) {
435 if (insn & (1 << 4)) {
436 /* single register transfer */
437 if ((insn & 0x6f) != 0x00)
439 rd = (insn >> 12) & 0xf;
443 rn = (insn >> 16) & 0xf;
444 /* Get the existing value even for arm->vfp moves because
445 we only set half the register. */
446 gen_mov_F0_vreg(1, rn);
448 if (insn & (1 << 20)) {
450 if (insn & (1 << 21))
451 gen_movl_reg_T1(s, rd);
453 gen_movl_reg_T0(s, rd);
456 if (insn & (1 << 21))
457 gen_movl_T1_reg(s, rd);
459 gen_movl_T0_reg(s, rd);
461 gen_mov_vreg_F0(dp, rn);
464 rn = ((insn >> 15) & 0x1e) | ((insn >> 7) & 1);
465 if (insn & (1 << 20)) {
467 if (insn & (1 << 21)) {
468 /* system register */
475 gen_op_vfp_movl_T0_fpscr_flags();
477 gen_op_vfp_movl_T0_fpscr();
483 gen_mov_F0_vreg(0, rn);
487 /* This will only set the 4 flag bits */
488 gen_op_movl_psr_T0();
490 gen_movl_reg_T0(s, rd);
493 gen_movl_T0_reg(s, rd);
494 if (insn & (1 << 21)) {
495 /* system register */
498 /* Writes are ignored. */
501 gen_op_vfp_movl_fpscr_T0();
502 /* This could change vector settings, so jump to
503 the next instuction. */
504 gen_op_movl_T0_im(s->pc);
505 gen_movl_reg_T0(s, 15);
506 s->is_jmp = DISAS_UPDATE;
513 gen_mov_vreg_F0(0, rn);
518 /* data processing */
519 /* The opcode is in bits 23, 21, 20 and 6. */
520 op = ((insn >> 20) & 8) | ((insn >> 19) & 6) | ((insn >> 6) & 1);
524 rn = ((insn >> 15) & 0x1e) | ((insn >> 7) & 1);
526 /* rn is register number */
529 rn = (insn >> 16) & 0xf;
532 if (op == 15 && (rn == 15 || rn > 17)) {
533 /* Integer or single precision destination. */
534 rd = ((insn >> 11) & 0x1e) | ((insn >> 22) & 1);
536 if (insn & (1 << 22))
538 rd = (insn >> 12) & 0xf;
541 if (op == 15 && (rn == 16 || rn == 17)) {
542 /* Integer source. */
543 rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
550 rn = ((insn >> 15) & 0x1e) | ((insn >> 7) & 1);
551 if (op == 15 && rn == 15) {
552 /* Double precision destination. */
553 if (insn & (1 << 22))
555 rd = (insn >> 12) & 0xf;
557 rd = ((insn >> 11) & 0x1e) | ((insn >> 22) & 1);
558 rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
561 veclen = env->vfp.vec_len;
562 if (op == 15 && rn > 3)
565 /* Shut up compiler warnings. */
576 /* Figure out what type of vector operation this is. */
577 if ((rd & bank_mask) == 0) {
582 delta_d = (env->vfp.vec_stride >> 1) + 1;
584 delta_d = env->vfp.vec_stride + 1;
586 if ((rm & bank_mask) == 0) {
587 /* mixed scalar/vector */
596 /* Load the initial operands. */
602 gen_mov_F0_vreg(0, rm);
607 gen_mov_F0_vreg(dp, rd);
608 gen_mov_F1_vreg(dp, rm);
612 /* Compare with zero */
613 gen_mov_F0_vreg(dp, rd);
617 /* One source operand. */
618 gen_mov_F0_vreg(dp, rm);
621 /* Two source operands. */
622 gen_mov_F0_vreg(dp, rn);
623 gen_mov_F1_vreg(dp, rm);
627 /* Perform the calculation. */
629 case 0: /* mac: fd + (fn * fm) */
631 gen_mov_F1_vreg(dp, rd);
634 case 1: /* nmac: fd - (fn * fm) */
637 gen_mov_F1_vreg(dp, rd);
640 case 2: /* msc: -fd + (fn * fm) */
642 gen_mov_F1_vreg(dp, rd);
645 case 3: /* nmsc: -fd - (fn * fm) */
647 gen_mov_F1_vreg(dp, rd);
651 case 4: /* mul: fn * fm */
654 case 5: /* nmul: -(fn * fm) */
658 case 6: /* add: fn + fm */
661 case 7: /* sub: fn - fm */
664 case 8: /* div: fn / fm */
667 case 15: /* extension space */
694 case 15: /* single<->double conversion */
709 case 25: /* ftouiz */
715 case 27: /* ftosiz */
718 default: /* undefined */
719 printf ("rn:%d\n", rn);
723 default: /* undefined */
724 printf ("op:%d\n", op);
728 /* Write back the result. */
729 if (op == 15 && (rn >= 8 && rn <= 11))
730 ; /* Comparison, do nothing. */
731 else if (op == 15 && rn > 17)
732 /* Integer result. */
733 gen_mov_vreg_F0(0, rd);
734 else if (op == 15 && rn == 15)
736 gen_mov_vreg_F0(!dp, rd);
738 gen_mov_vreg_F0(dp, rd);
740 /* break out of the loop if we have finished */
744 if (op == 15 && delta_m == 0) {
745 /* single source one-many */
747 rd = ((rd + delta_d) & (bank_mask - 1))
749 gen_mov_vreg_F0(dp, rd);
753 /* Setup the next operands. */
755 rd = ((rd + delta_d) & (bank_mask - 1))
759 /* One source operand. */
760 rm = ((rm + delta_m) & (bank_mask - 1))
762 gen_mov_F0_vreg(dp, rm);
764 /* Two source operands. */
765 rn = ((rn + delta_d) & (bank_mask - 1))
767 gen_mov_F0_vreg(dp, rn);
769 rm = ((rm + delta_m) & (bank_mask - 1))
771 gen_mov_F1_vreg(dp, rm);
779 if (dp && (insn & (1 << 22))) {
780 /* two-register transfer */
781 rn = (insn >> 16) & 0xf;
782 rd = (insn >> 12) & 0xf;
788 rm = ((insn << 1) & 0x1e) | ((insn >> 5) & 1);
790 if (insn & (1 << 20)) {
793 gen_mov_F0_vreg(1, rm);
795 gen_movl_reg_T0(s, rd);
796 gen_movl_reg_T1(s, rn);
798 gen_mov_F0_vreg(0, rm);
800 gen_movl_reg_T0(s, rn);
801 gen_mov_F0_vreg(0, rm + 1);
803 gen_movl_reg_T0(s, rd);
808 gen_movl_T0_reg(s, rd);
809 gen_movl_T1_reg(s, rn);
811 gen_mov_vreg_F0(1, rm);
813 gen_movl_T0_reg(s, rn);
815 gen_mov_vreg_F0(0, rm);
816 gen_movl_T0_reg(s, rd);
818 gen_mov_vreg_F0(0, rm + 1);
823 rn = (insn >> 16) & 0xf;
825 rd = (insn >> 12) & 0xf;
827 rd = ((insn >> 11) & 0x1e) | ((insn >> 22) & 1);
828 gen_movl_T1_reg(s, rn);
829 if ((insn & 0x01200000) == 0x01000000) {
830 /* Single load/store */
831 offset = (insn & 0xff) << 2;
832 if ((insn & (1 << 23)) == 0)
834 gen_op_addl_T1_im(offset);
835 if (insn & (1 << 20)) {
837 gen_mov_vreg_F0(dp, rd);
839 gen_mov_F0_vreg(dp, rd);
843 /* load/store multiple */
845 n = (insn >> 1) & 0x7f;
849 if (insn & (1 << 24)) /* pre-decrement */
850 gen_op_addl_T1_im(-((insn & 0xff) << 2));
856 for (i = 0; i < n; i++) {
857 if (insn & (1 << 20)) {
860 gen_mov_vreg_F0(dp, rd + i);
863 gen_mov_F0_vreg(dp, rd + i);
866 gen_op_addl_T1_im(offset);
868 if (insn & (1 << 21)) {
870 if (insn & (1 << 24))
871 offset = -offset * n;
872 else if (dp && (insn & 1))
878 gen_op_addl_T1_im(offset);
879 gen_movl_reg_T1(s, rn);
885 /* Should never happen. */
891 static void disas_arm_insn(CPUState * env, DisasContext *s)
893 unsigned int cond, insn, val, op1, i, shift, rm, rs, rn, rd, sh;
900 /* Unconditional instructions. */
901 if ((insn & 0x0d70f000) == 0x0550f000)
903 else if ((insn & 0x0e000000) == 0x0a000000) {
904 /* branch link and change to thumb (blx <offset>) */
907 val = (uint32_t)s->pc;
908 gen_op_movl_T0_im(val);
909 gen_movl_reg_T0(s, 14);
910 /* Sign-extend the 24-bit offset */
911 offset = (((int32_t)insn) << 8) >> 8;
912 /* offset * 4 + bit24 * 2 + (thumb bit) */
913 val += (offset << 2) | ((insn >> 23) & 2) | 1;
914 /* pipeline offset */
916 gen_op_movl_T0_im(val);
919 } else if ((insn & 0x0fe00000) == 0x0c400000) {
920 /* Coprocessor double register transfer. */
921 } else if ((insn & 0x0f000010) == 0x0e000010) {
922 /* Additional coprocessor register transfer. */
927 /* if not always execute, we generate a conditional jump to
929 gen_test_cc[cond ^ 1]((long)s->tb, (long)s->pc);
930 s->is_jmp = DISAS_JUMP_NEXT;
932 if ((insn & 0x0f900000) == 0x03000000) {
933 if ((insn & 0x0ff0f000) != 0x0360f000)
935 /* CPSR = immediate */
937 shift = ((insn >> 8) & 0xf) * 2;
939 val = (val >> shift) | (val << (32 - shift));
940 gen_op_movl_T0_im(val);
941 if (insn & (1 << 19))
942 gen_op_movl_psr_T0();
943 } else if ((insn & 0x0f900000) == 0x01000000
944 && (insn & 0x00000090) != 0x00000090) {
945 /* miscellaneous instructions */
946 op1 = (insn >> 21) & 3;
947 sh = (insn >> 4) & 0xf;
950 case 0x0: /* move program status register */
952 /* SPSR not accessible in user mode */
957 gen_movl_T0_reg(s, rm);
958 if (insn & (1 << 19))
959 gen_op_movl_psr_T0();
962 rd = (insn >> 12) & 0xf;
963 gen_op_movl_T0_psr();
964 gen_movl_reg_T0(s, rd);
969 /* branch/exchange thumb (bx). */
970 gen_movl_T0_reg(s, rm);
972 } else if (op1 == 3) {
974 rd = (insn >> 12) & 0xf;
975 gen_movl_T0_reg(s, rm);
977 gen_movl_reg_T0(s, rd);
986 /* branch link/exchange thumb (blx) */
987 val = (uint32_t)s->pc;
988 gen_op_movl_T0_im(val);
989 gen_movl_reg_T0(s, 14);
990 gen_movl_T0_reg(s, rm);
993 case 0x5: /* saturating add/subtract */
994 rd = (insn >> 12) & 0xf;
995 rn = (insn >> 16) & 0xf;
996 gen_movl_T0_reg(s, rn);
998 gen_movl_T1_reg(s, rn);
1000 gen_op_subl_T0_T1_saturate();
1002 gen_op_addl_T0_T1_saturate();
1004 gen_movl_T1_reg(s, rm);
1006 gen_op_subl_T0_T1_saturate();
1008 gen_op_addl_T0_T1_saturate();
1009 gen_movl_reg_T0(s, rn);
1011 case 0x8: /* signed multiply */
1015 rs = (insn >> 8) & 0xf;
1016 rn = (insn >> 12) & 0xf;
1017 rd = (insn >> 16) & 0xf;
1019 /* (32 * 16) >> 16 */
1020 gen_movl_T0_reg(s, rm);
1021 gen_movl_T1_reg(s, rs);
1023 gen_op_sarl_T1_im(16);
1026 gen_op_imulw_T0_T1();
1027 if ((sh & 2) == 0) {
1028 gen_movl_T1_reg(s, rn);
1029 gen_op_addl_T0_T1_setq();
1031 gen_movl_reg_T0(s, rd);
1034 gen_movl_T0_reg(s, rm);
1036 gen_op_sarl_T0_im(16);
1039 gen_movl_T1_reg(s, rs);
1041 gen_op_sarl_T1_im(16);
1045 gen_op_imull_T0_T1();
1046 gen_op_addq_T0_T1(rn, rd);
1047 gen_movl_reg_T0(s, rn);
1048 gen_movl_reg_T1(s, rd);
1052 gen_movl_T1_reg(s, rn);
1053 gen_op_addl_T0_T1_setq();
1055 gen_movl_reg_T0(s, rd);
1062 } else if (((insn & 0x0e000000) == 0 &&
1063 (insn & 0x00000090) != 0x90) ||
1064 ((insn & 0x0e000000) == (1 << 25))) {
1065 int set_cc, logic_cc, shiftop;
1067 op1 = (insn >> 21) & 0xf;
1068 set_cc = (insn >> 20) & 1;
1069 logic_cc = table_logic_cc[op1] & set_cc;
1071 /* data processing instruction */
1072 if (insn & (1 << 25)) {
1073 /* immediate operand */
1075 shift = ((insn >> 8) & 0xf) * 2;
1077 val = (val >> shift) | (val << (32 - shift));
1078 gen_op_movl_T1_im(val);
1079 if (logic_cc && shift)
1084 gen_movl_T1_reg(s, rm);
1085 shiftop = (insn >> 5) & 3;
1086 if (!(insn & (1 << 4))) {
1087 shift = (insn >> 7) & 0x1f;
1090 gen_shift_T1_im_cc[shiftop](shift);
1092 gen_shift_T1_im[shiftop](shift);
1094 } else if (shiftop != 0) {
1096 gen_shift_T1_0_cc[shiftop]();
1098 gen_shift_T1_0[shiftop]();
1102 rs = (insn >> 8) & 0xf;
1103 gen_movl_T0_reg(s, rs);
1105 gen_shift_T1_T0_cc[shiftop]();
1107 gen_shift_T1_T0[shiftop]();
1111 if (op1 != 0x0f && op1 != 0x0d) {
1112 rn = (insn >> 16) & 0xf;
1113 gen_movl_T0_reg(s, rn);
1115 rd = (insn >> 12) & 0xf;
1118 gen_op_andl_T0_T1();
1119 gen_movl_reg_T0(s, rd);
1121 gen_op_logic_T0_cc();
1124 gen_op_xorl_T0_T1();
1125 gen_movl_reg_T0(s, rd);
1127 gen_op_logic_T0_cc();
1131 gen_op_subl_T0_T1_cc();
1133 gen_op_subl_T0_T1();
1134 gen_movl_reg_T0(s, rd);
1138 gen_op_rsbl_T0_T1_cc();
1140 gen_op_rsbl_T0_T1();
1141 gen_movl_reg_T0(s, rd);
1145 gen_op_addl_T0_T1_cc();
1147 gen_op_addl_T0_T1();
1148 gen_movl_reg_T0(s, rd);
1152 gen_op_adcl_T0_T1_cc();
1154 gen_op_adcl_T0_T1();
1155 gen_movl_reg_T0(s, rd);
1159 gen_op_sbcl_T0_T1_cc();
1161 gen_op_sbcl_T0_T1();
1162 gen_movl_reg_T0(s, rd);
1166 gen_op_rscl_T0_T1_cc();
1168 gen_op_rscl_T0_T1();
1169 gen_movl_reg_T0(s, rd);
1173 gen_op_andl_T0_T1();
1174 gen_op_logic_T0_cc();
1179 gen_op_xorl_T0_T1();
1180 gen_op_logic_T0_cc();
1185 gen_op_subl_T0_T1_cc();
1190 gen_op_addl_T0_T1_cc();
1195 gen_movl_reg_T0(s, rd);
1197 gen_op_logic_T0_cc();
1200 gen_movl_reg_T1(s, rd);
1202 gen_op_logic_T1_cc();
1205 gen_op_bicl_T0_T1();
1206 gen_movl_reg_T0(s, rd);
1208 gen_op_logic_T0_cc();
1213 gen_movl_reg_T1(s, rd);
1215 gen_op_logic_T1_cc();
1219 /* other instructions */
1220 op1 = (insn >> 24) & 0xf;
1224 /* multiplies, extra load/stores */
1225 sh = (insn >> 5) & 3;
1228 rd = (insn >> 16) & 0xf;
1229 rn = (insn >> 12) & 0xf;
1230 rs = (insn >> 8) & 0xf;
1232 if (((insn >> 22) & 3) == 0) {
1234 gen_movl_T0_reg(s, rs);
1235 gen_movl_T1_reg(s, rm);
1237 if (insn & (1 << 21)) {
1238 gen_movl_T1_reg(s, rn);
1239 gen_op_addl_T0_T1();
1241 if (insn & (1 << 20))
1242 gen_op_logic_T0_cc();
1243 gen_movl_reg_T0(s, rd);
1246 gen_movl_T0_reg(s, rs);
1247 gen_movl_T1_reg(s, rm);
1248 if (insn & (1 << 22))
1249 gen_op_imull_T0_T1();
1251 gen_op_mull_T0_T1();
1252 if (insn & (1 << 21)) /* mult accumulate */
1253 gen_op_addq_T0_T1(rn, rd);
1254 if (!(insn & (1 << 23))) { /* double accumulate */
1255 gen_op_addq_lo_T0_T1(rn);
1256 gen_op_addq_lo_T0_T1(rd);
1258 if (insn & (1 << 20))
1260 gen_movl_reg_T0(s, rn);
1261 gen_movl_reg_T1(s, rd);
1264 rn = (insn >> 16) & 0xf;
1265 rd = (insn >> 12) & 0xf;
1266 if (insn & (1 << 23)) {
1267 /* load/store exclusive */
1270 /* SWP instruction */
1273 gen_movl_T0_reg(s, rm);
1274 gen_movl_T1_reg(s, rn);
1275 if (insn & (1 << 22)) {
1276 gen_op_swpb_T0_T1();
1278 gen_op_swpl_T0_T1();
1280 gen_movl_reg_T0(s, rd);
1284 /* Misc load/store */
1285 rn = (insn >> 16) & 0xf;
1286 rd = (insn >> 12) & 0xf;
1287 gen_movl_T1_reg(s, rn);
1288 if (insn & (1 << 24))
1289 gen_add_datah_offset(s, insn);
1290 if (insn & (1 << 20)) {
1294 gen_op_lduw_T0_T1();
1297 gen_op_ldsb_T0_T1();
1301 gen_op_ldsw_T0_T1();
1304 gen_movl_reg_T0(s, rd);
1305 } else if (sh & 2) {
1309 gen_movl_T0_reg(s, rd);
1311 gen_op_addl_T1_im(4);
1312 gen_movl_T0_reg(s, rd + 1);
1314 if ((insn & (1 << 24)) || (insn & (1 << 20)))
1315 gen_op_addl_T1_im(-4);
1319 gen_movl_reg_T0(s, rd);
1320 gen_op_addl_T1_im(4);
1322 gen_movl_reg_T0(s, rd + 1);
1323 if ((insn & (1 << 24)) || (insn & (1 << 20)))
1324 gen_op_addl_T1_im(-4);
1328 gen_movl_T0_reg(s, rd);
1331 if (!(insn & (1 << 24))) {
1332 gen_add_datah_offset(s, insn);
1333 gen_movl_reg_T1(s, rn);
1334 } else if (insn & (1 << 21)) {
1335 gen_movl_reg_T1(s, rn);
1343 /* load/store byte/word */
1344 rn = (insn >> 16) & 0xf;
1345 rd = (insn >> 12) & 0xf;
1346 gen_movl_T1_reg(s, rn);
1347 if (insn & (1 << 24))
1348 gen_add_data_offset(s, insn);
1349 if (insn & (1 << 20)) {
1351 if (insn & (1 << 22))
1352 gen_op_ldub_T0_T1();
1358 gen_movl_reg_T0(s, rd);
1361 gen_movl_T0_reg(s, rd);
1362 if (insn & (1 << 22))
1367 if (!(insn & (1 << 24))) {
1368 gen_add_data_offset(s, insn);
1369 gen_movl_reg_T1(s, rn);
1370 } else if (insn & (1 << 21))
1371 gen_movl_reg_T1(s, rn); {
1378 /* load/store multiple words */
1379 /* XXX: store correct base if write back */
1380 if (insn & (1 << 22))
1381 goto illegal_op; /* only usable in supervisor mode */
1382 rn = (insn >> 16) & 0xf;
1383 gen_movl_T1_reg(s, rn);
1385 /* compute total size */
1388 if (insn & (1 << i))
1391 /* XXX: test invalid n == 0 case ? */
1392 if (insn & (1 << 23)) {
1393 if (insn & (1 << 24)) {
1395 gen_op_addl_T1_im(4);
1397 /* post increment */
1400 if (insn & (1 << 24)) {
1402 gen_op_addl_T1_im(-(n * 4));
1404 /* post decrement */
1406 gen_op_addl_T1_im(-((n - 1) * 4));
1411 if (insn & (1 << i)) {
1412 if (insn & (1 << 20)) {
1418 gen_movl_reg_T0(s, i);
1422 /* special case: r15 = PC + 12 */
1423 val = (long)s->pc + 8;
1424 gen_op_movl_TN_im[0](val);
1426 gen_movl_T0_reg(s, i);
1431 /* no need to add after the last transfer */
1433 gen_op_addl_T1_im(4);
1436 if (insn & (1 << 21)) {
1438 if (insn & (1 << 23)) {
1439 if (insn & (1 << 24)) {
1442 /* post increment */
1443 gen_op_addl_T1_im(4);
1446 if (insn & (1 << 24)) {
1449 gen_op_addl_T1_im(-((n - 1) * 4));
1451 /* post decrement */
1452 gen_op_addl_T1_im(-(n * 4));
1455 gen_movl_reg_T1(s, rn);
1464 /* branch (and link) */
1465 val = (int32_t)s->pc;
1466 if (insn & (1 << 24)) {
1467 gen_op_movl_T0_im(val);
1468 gen_op_movl_reg_TN[0][14]();
1470 offset = (((int32_t)insn << 8) >> 8);
1471 val += (offset << 2) + 4;
1472 gen_op_jmp((long)s->tb, val);
1473 s->is_jmp = DISAS_TB_JUMP;
1480 op1 = (insn >> 8) & 0xf;
1484 if (disas_vfp_insn (env, s, insn))
1488 /* unknown coprocessor. */
1494 gen_op_movl_T0_im((long)s->pc);
1495 gen_op_movl_reg_TN[0][15]();
1497 s->is_jmp = DISAS_JUMP;
1501 gen_op_movl_T0_im((long)s->pc - 4);
1502 gen_op_movl_reg_TN[0][15]();
1503 gen_op_undef_insn();
1504 s->is_jmp = DISAS_JUMP;
1510 static void disas_thumb_insn(DisasContext *s)
1512 uint32_t val, insn, op, rm, rn, rd, shift, cond;
1519 switch (insn >> 12) {
1522 op = (insn >> 11) & 3;
1525 rn = (insn >> 3) & 7;
1526 gen_movl_T0_reg(s, rn);
1527 if (insn & (1 << 10)) {
1529 gen_op_movl_T1_im((insn >> 6) & 7);
1532 rm = (insn >> 6) & 7;
1533 gen_movl_T1_reg(s, rm);
1535 if (insn & (1 << 9))
1536 gen_op_addl_T0_T1_cc();
1538 gen_op_addl_T0_T1_cc();
1539 gen_movl_reg_T0(s, rd);
1541 /* shift immediate */
1542 rm = (insn >> 3) & 7;
1543 shift = (insn >> 6) & 0x1f;
1544 gen_movl_T0_reg(s, rm);
1545 gen_shift_T0_im_thumb[op](shift);
1546 gen_movl_reg_T0(s, rd);
1550 /* arithmetic large immediate */
1551 op = (insn >> 11) & 3;
1552 rd = (insn >> 8) & 0x7;
1554 gen_op_movl_T0_im(insn & 0xff);
1556 gen_movl_T0_reg(s, rd);
1557 gen_op_movl_T1_im(insn & 0xff);
1561 gen_op_logic_T0_cc();
1564 gen_op_subl_T0_T1_cc();
1567 gen_op_addl_T0_T1_cc();
1570 gen_op_subl_T0_T1_cc();
1574 gen_movl_reg_T0(s, rd);
1577 if (insn & (1 << 11)) {
1578 rd = (insn >> 8) & 7;
1579 /* load pc-relative */
1580 val = (insn & 0xff) * 4;
1581 gen_op_movl_T1_im(val);
1582 gen_movl_T2_reg(s, 15);
1583 gen_op_addl_T1_T2();
1585 gen_movl_reg_T0(s, rd);
1588 if (insn & (1 << 10)) {
1589 /* data processing extended or blx */
1590 rd = (insn & 7) | ((insn >> 4) & 8);
1591 rm = (insn >> 3) & 0xf;
1592 op = (insn >> 8) & 3;
1595 gen_movl_T0_reg(s, rd);
1596 gen_movl_T1_reg(s, rm);
1597 gen_op_addl_T0_T1();
1598 gen_movl_reg_T0(s, rd);
1601 gen_movl_T0_reg(s, rd);
1602 gen_movl_T1_reg(s, rm);
1603 gen_op_subl_T0_T1_cc();
1605 case 2: /* mov/cpy */
1606 gen_movl_T0_reg(s, rm);
1607 gen_movl_reg_T0(s, rd);
1609 case 3:/* branch [and link] exchange thumb register */
1610 if (insn & (1 << 7)) {
1611 val = (uint32_t)s->pc | 1;
1612 gen_op_movl_T1_im(val);
1613 gen_movl_reg_T1(s, 14);
1615 gen_movl_T0_reg(s, rm);
1622 /* data processing register */
1624 rm = (insn >> 3) & 7;
1625 op = (insn >> 6) & 0xf;
1626 if (op == 2 || op == 3 || op == 4 || op == 7) {
1627 /* the shift/rotate ops want the operands backwards */
1636 if (op == 9) /* neg */
1637 gen_op_movl_T0_im(0);
1638 else if (op != 0xf) /* mvn doesn't read its first operand */
1639 gen_movl_T0_reg(s, rd);
1641 gen_movl_T1_reg(s, rm);
1642 switch (insn >> 6) {
1644 gen_op_andl_T0_T1();
1645 gen_op_logic_T0_cc();
1648 gen_op_xorl_T0_T1();
1649 gen_op_logic_T0_cc();
1652 gen_op_shll_T1_T0_cc();
1655 gen_op_shrl_T1_T0_cc();
1658 gen_op_sarl_T1_T0_cc();
1661 gen_op_adcl_T0_T1_cc();
1664 gen_op_sbcl_T0_T1_cc();
1667 gen_op_rorl_T1_T0_cc();
1670 gen_op_andl_T0_T1();
1671 gen_op_logic_T0_cc();
1674 gen_op_rsbl_T0_T1_cc();
1677 gen_op_subl_T0_T1_cc();
1681 gen_op_addl_T0_T1_cc();
1686 gen_op_logic_T0_cc();
1689 gen_op_mull_T0_T1();
1690 gen_op_logic_T0_cc();
1693 gen_op_bicl_T0_T1();
1694 gen_op_logic_T0_cc();
1698 gen_op_logic_T1_cc();
1704 gen_movl_reg_T1(s, rd);
1706 gen_movl_reg_T0(s, rd);
1711 /* load/store register offset. */
1713 rn = (insn >> 3) & 7;
1714 rm = (insn >> 6) & 7;
1715 op = (insn >> 9) & 7;
1716 gen_movl_T1_reg(s, rn);
1717 gen_movl_T2_reg(s, rm);
1718 gen_op_addl_T1_T2();
1720 if (op < 3) /* store */
1721 gen_movl_T0_reg(s, rd);
1734 gen_op_ldsb_T0_T1();
1740 gen_op_ldsw_T0_T1();
1743 gen_op_ldub_T0_T1();
1746 gen_op_ldsw_T0_T1();
1749 if (op >= 3) /* load */
1750 gen_movl_reg_T0(s, rd);
1754 /* load/store word immediate offset */
1756 rn = (insn >> 3) & 7;
1757 gen_movl_T1_reg(s, rn);
1758 val = (insn >> 4) & 0x7c;
1759 gen_op_movl_T2_im(val);
1760 gen_op_addl_T1_T2();
1762 if (insn & (1 << 11)) {
1765 gen_movl_reg_T0(s, rd);
1768 gen_movl_T0_reg(s, rd);
1774 /* load/store byte immediate offset */
1776 rn = (insn >> 3) & 7;
1777 gen_movl_T1_reg(s, rn);
1778 val = (insn >> 6) & 0x1f;
1779 gen_op_movl_T2_im(val);
1780 gen_op_addl_T1_T2();
1782 if (insn & (1 << 11)) {
1784 gen_op_ldub_T0_T1();
1785 gen_movl_reg_T0(s, rd);
1788 gen_movl_T0_reg(s, rd);
1794 /* load/store halfword immediate offset */
1796 rn = (insn >> 3) & 7;
1797 gen_movl_T1_reg(s, rn);
1798 val = (insn >> 5) & 0x3e;
1799 gen_op_movl_T2_im(val);
1800 gen_op_addl_T1_T2();
1802 if (insn & (1 << 11)) {
1804 gen_op_lduw_T0_T1();
1805 gen_movl_reg_T0(s, rd);
1808 gen_movl_T0_reg(s, rd);
1814 /* load/store from stack */
1815 rd = (insn >> 8) & 7;
1816 gen_movl_T1_reg(s, 13);
1817 val = (insn & 0xff) * 4;
1818 gen_op_movl_T2_im(val);
1819 gen_op_addl_T1_T2();
1821 if (insn & (1 << 11)) {
1824 gen_movl_reg_T0(s, rd);
1827 gen_movl_T0_reg(s, rd);
1833 /* add to high reg */
1834 rd = (insn >> 8) & 7;
1835 if (insn & (1 << 11))
1839 gen_movl_T0_reg(s, rm);
1840 val = (insn & 0xff) * 4;
1841 gen_op_movl_T1_im(val);
1842 gen_op_addl_T0_T1();
1843 gen_movl_reg_T0(s, rd);
1848 op = (insn >> 8) & 0xf;
1851 /* adjust stack pointer */
1852 gen_movl_T1_reg(s, 13);
1853 val = (insn & 0x7f) * 4;
1854 if (insn & (1 << 7))
1855 val = -(int32_t)val;
1856 gen_op_movl_T2_im(val);
1857 gen_op_addl_T1_T2();
1858 gen_movl_reg_T1(s, 13);
1861 case 4: case 5: case 0xc: case 0xd:
1863 gen_movl_T1_reg(s, 13);
1864 if (insn & (1 << 11))
1868 gen_op_movl_T2_im(val);
1869 for (i = 0; i < 8; i++) {
1870 if (insn & (1 << i)) {
1871 if (insn & (1 << 11)) {
1874 gen_movl_reg_T0(s, i);
1877 gen_movl_T0_reg(s, i);
1880 /* move to the next address */
1881 gen_op_addl_T1_T2();
1884 if (insn & (1 << 8)) {
1885 if (insn & (1 << 11)) {
1888 /* don't set the pc until the rest of the instruction
1892 gen_movl_T0_reg(s, 14);
1895 gen_op_addl_T1_T2();
1898 /* write back the new stack pointer */
1899 gen_movl_reg_T1(s, 13);
1900 /* set the new PC value */
1901 if ((insn & 0x0900) == 0x0900)
1911 /* load/store multiple */
1912 rn = (insn >> 8) & 0x7;
1913 gen_movl_T1_reg(s, rn);
1914 gen_op_movl_T2_im(4);
1916 for (i = 0; i < 8; i++) {
1917 if (insn & (1 << i)) {
1918 /* advance to the next address */
1920 gen_op_addl_T1_T2();
1923 if (insn & (1 << 11)) {
1926 gen_movl_reg_T0(s, i);
1929 gen_movl_T0_reg(s, i);
1937 /* conditional branch or swi */
1938 cond = (insn >> 8) & 0xf;
1944 gen_op_movl_T0_im((long)s->pc | 1);
1945 /* Don't set r15. */
1946 gen_op_movl_reg_TN[0][15]();
1948 s->is_jmp = DISAS_JUMP;
1951 /* generate a conditional jump to next instruction */
1952 gen_test_cc[cond ^ 1]((long)s->tb, (long)s->pc);
1953 s->is_jmp = DISAS_JUMP_NEXT;
1954 gen_movl_T1_reg(s, 15);
1956 /* jump to the offset */
1957 val = (uint32_t)s->pc;
1958 offset = ((int32_t)insn << 24) >> 24;
1959 val += (offset << 1) + 2;
1960 gen_op_jmp((long)s->tb, val);
1961 s->is_jmp = DISAS_TB_JUMP;
1965 /* unconditional branch */
1966 if (insn & (1 << 11))
1967 goto undef; /* Second half of a blx */
1968 val = (uint32_t)s->pc;
1969 offset = ((int32_t)insn << 21) >> 21;
1970 val += (offset << 1) + 2;
1971 gen_op_jmp((long)s->tb, val);
1972 s->is_jmp = DISAS_TB_JUMP;
1976 /* branch and link [and switch to arm] */
1977 offset = ((int32_t)insn << 21) >> 10;
1979 offset |= insn & 0x7ff;
1981 val = (uint32_t)s->pc + 2;
1982 gen_op_movl_T1_im(val | 1);
1983 gen_movl_reg_T1(s, 14);
1986 if (insn & (1 << 11)) {
1988 gen_op_jmp((long)s->tb, val);
1989 s->is_jmp = DISAS_TB_JUMP;
1992 gen_op_movl_T0_im(val);
1998 gen_op_movl_T0_im((long)s->pc - 4);
1999 gen_op_movl_reg_TN[0][15]();
2000 gen_op_undef_insn();
2001 s->is_jmp = DISAS_JUMP;
2004 /* generate intermediate code in gen_opc_buf and gen_opparam_buf for
2005 basic block 'tb'. If search_pc is TRUE, also generate PC
2006 information for each intermediate instruction. */
2007 static inline int gen_intermediate_code_internal(CPUState *env,
2008 TranslationBlock *tb,
2011 DisasContext dc1, *dc = &dc1;
2012 uint16_t *gen_opc_end;
2014 target_ulong pc_start;
2016 /* generate intermediate code */
2021 gen_opc_ptr = gen_opc_buf;
2022 gen_opc_end = gen_opc_buf + OPC_MAX_SIZE;
2023 gen_opparam_ptr = gen_opparam_buf;
2025 dc->is_jmp = DISAS_NEXT;
2029 if (env->nb_breakpoints > 0) {
2030 for(j = 0; j < env->nb_breakpoints; j++) {
2031 if (env->breakpoints[j] == dc->pc) {
2032 gen_op_movl_T0_im((long)dc->pc);
2033 gen_op_movl_reg_TN[0][15]();
2035 dc->is_jmp = DISAS_JUMP;
2041 j = gen_opc_ptr - gen_opc_buf;
2045 gen_opc_instr_start[lj++] = 0;
2047 gen_opc_pc[lj] = dc->pc;
2048 gen_opc_instr_start[lj] = 1;
2051 disas_thumb_insn(dc);
2053 disas_arm_insn(env, dc);
2054 } while (!dc->is_jmp && gen_opc_ptr < gen_opc_end &&
2055 !env->singlestep_enabled &&
2056 (dc->pc - pc_start) < (TARGET_PAGE_SIZE - 32));
2057 switch(dc->is_jmp) {
2058 case DISAS_JUMP_NEXT:
2060 gen_op_jmp((long)dc->tb, (long)dc->pc);
2065 /* indicate that the hash table must be used to find the next TB */
2070 /* nothing more to generate */
2073 *gen_opc_ptr = INDEX_op_end;
2076 if (loglevel & CPU_LOG_TB_IN_ASM) {
2077 fprintf(logfile, "----------------\n");
2078 fprintf(logfile, "IN: %s\n", lookup_symbol(pc_start));
2079 target_disas(logfile, pc_start, dc->pc - pc_start, 0);
2080 fprintf(logfile, "\n");
2081 if (loglevel & (CPU_LOG_TB_OP)) {
2082 fprintf(logfile, "OP:\n");
2083 dump_ops(gen_opc_buf, gen_opparam_buf);
2084 fprintf(logfile, "\n");
2089 tb->size = dc->pc - pc_start;
2093 int gen_intermediate_code(CPUState *env, TranslationBlock *tb)
2095 return gen_intermediate_code_internal(env, tb, 0);
2098 int gen_intermediate_code_pc(CPUState *env, TranslationBlock *tb)
2100 return gen_intermediate_code_internal(env, tb, 1);
2103 CPUARMState *cpu_arm_init(void)
2109 env = malloc(sizeof(CPUARMState));
2112 memset(env, 0, sizeof(CPUARMState));
2113 cpu_single_env = env;
2117 void cpu_arm_close(CPUARMState *env)
2122 void cpu_dump_state(CPUState *env, FILE *f,
2123 int (*cpu_fprintf)(FILE *f, const char *fmt, ...),
2134 cpu_fprintf(f, "R%02d=%08x", i, env->regs[i]);
2136 cpu_fprintf(f, "\n");
2138 cpu_fprintf(f, " ");
2140 cpu_fprintf(f, "PSR=%08x %c%c%c%c\n",
2142 env->cpsr & (1 << 31) ? 'N' : '-',
2143 env->cpsr & (1 << 30) ? 'Z' : '-',
2144 env->cpsr & (1 << 29) ? 'C' : '-',
2145 env->cpsr & (1 << 28) ? 'V' : '-');
2147 for (i = 0; i < 16; i++) {
2148 d.d = env->vfp.regs[i];
2151 cpu_fprintf(f, "s%02d=%08x(%8f) s%02d=%08x(%8f) d%02d=%08x%08x(%8f)\n",
2152 i * 2, (int)s0.i, s0.s,
2153 i * 2 + 1, (int)s0.i, s0.s,
2154 i, (int)(uint32_t)d.l.upper, (int)(uint32_t)d.l.lower,
2156 cpu_fprintf(f, "FPSCR: %08x\n", (int)env->vfp.fpscr);
2160 target_ulong cpu_get_phys_page_debug(CPUState *env, target_ulong addr)
2165 #if defined(CONFIG_USER_ONLY)
2167 int cpu_arm_handle_mmu_fault (CPUState *env, target_ulong address, int rw,
2168 int is_user, int is_softmmu)
2170 env->cp15_6 = address;
2172 env->exception_index = EXCP_PREFETCH_ABORT;
2174 env->exception_index = EXCP_DATA_ABORT;
2181 #error not implemented