8 #define FRMT "0x%x" // "0x%x"
9 #define SHFTFRMC "%s %s #%d" // "%s %s %d"
10 #define SHFTFRMR "%s %s %s" // "%s %s %s"
12 //#define SHFTFRMC "%s %s %d"
13 //#define SHFTFRMR "%s %s %s"
15 char *cond
[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", "", "nv" };
16 char *cnd1
[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", " ", "nv" };
17 char *opcd
[16] = {"and","eor","sub","rsb","add","adc","sbc","rsc","tst","teq","cmp","cmn","orr","mov","bic","mvn" };
18 char setc
[32] = {0,115,0,115,0,115,0,115,0,115,0,115,0,115,0,115,0, 0 ,0, 0 ,0, 0 ,0, 0 ,0,115,0,115,0,115,0,115 };
19 char *regs
[16] = { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "sl", "fp", "ip", "sp", "lr", "pc" };
21 char *shfts
[4] = { "lsl", "lsr", "asr", "ror" };
24 31-28 27 26 25 24 23 22 21 20 19 18 17 16 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
25 Cond 0 0 I ---Opcode--- S |----Rn----- ----Rd----- --------Operand 2-------- Data Processing /PSR Transfer
26 Cond 0 0 0 0 | 0 0 A S |----Rd----- ----Rn----- ---Rs---- 1 0 0 1 --Rm--- Multiply
27 Cond 0 0 0 0 | 1 U A S |---RdHi---- ---RdLo---- ---Rn---- 1 0 0 1 --Rm--- Multiply Long
28 Cond 0 0 0 1 | 0 B 0 0 |----Rn----- ----Rd----- 0 0 0 0 1 0 0 1 --Rm--- Single Data Swap
29 Cond 0 0 0 1 | 0 0 1 0 |1 1 1 1 1 1 1 1 1 1 1 1 0 0 0 1 --Rn--- Branch and Exchange
30 Cond 0 0 0 P | U 0 W L |----Rn----- ----Rd----- 0 0 0 0 1 S H 1 --Rm--- Halfword Data Transfer: register offset
31 Cond 0 0 0 P | U 1 W L |----Rn----- ----Rd----- --Offset- 1 S H 1 -Offset Halfword Data Transfer: immediate offset
32 Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
33 Cond 0 1 1 1 | x x x x |x x x x x x x x x x x x x x x 1 x x x x Undefined
34 Cond 1 0 0 P | U S W L |----Rn----- -----------Register List------------- Block Data Transfer
35 Cond 1 0 1 L | -------------------------Offset------------------------------ Branch
36 Cond 1 1 0 P | U N W L |----Rn----- ----CRd---- ---CP#--- -----Offset---- Coprocessor Data Transfer
37 Cond 1 1 1 0 | --CP Opc---|----CRn---- ----CRd---- ---CP#--- -CP-- 0 --CRm-- Coprocessor Data Operation
38 Cond 1 1 1 0 | CP Opc L |----CRn---- ----Rd----- ---CP#--- -CP-- 1 --CRm-- Coprocessor Register Transfer
39 Cond 1 1 1 1 | x x x x |x x x x x x x x x x x x x x x x x x x x Software Interrupt
42 0001 0 0 0 0 0 1 1 0 6 e 1 1 1 0 1 8
43 ================================================================================
44 Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
48 NE 1 Z clear not equal
49 CS 2 C set unsigned higher or same
50 CC 3 C clear unsigned lower
52 PL 5 N clear positive or zero
54 VC 7 V clear no overflow
55 HI 8 C set and Z clear unsigned higher
56 LS 9 C clear or Z set unsigned lower or same
57 GE A N equals V greater or equal
58 LT B N not equal to V less than
59 GT C Z clear AND (N equals V) greater than
60 LE D Z set OR (N not equal to V) less than or equal
63 AND 0 operand1 AND operand2
64 EOR 1 operand1 EOR operand2
65 SUB 2 operand1 - operand2
66 RSB 3 operand2 - operand1
67 ADD 4 operand1 + operand2
68 ADC 5 operand1 + operand2 + carry
69 SBC 6 operand1 - operand2 + carry - 1
70 RSC 7 operand2 - operand1 + carry - 1
71 TST 8 AND, but result is not written
72 TEQ 9 as EOR, but result is not written
73 CMP A as SUB, but result is not written
74 CMN B as ADD, but result is not written
75 ORR C operand1 OR operand2
76 MOV D operand2 (operand1 is ignored)
77 BIC E operand1 AND NOT operand2 (Bit clear)
78 MVN F NOT operand2 (operand1 is ignored)
81 void multiply_stg(char *stg
, ULONG val
)
83 if((val
&0xc00000) == 0) // simple mul
85 if(val
& 0x100000) // set condition flags
86 if(val
& 0x200000) sprintf(stg
+strlen(stg
), "mla%ss ", cond
[val
>>28]);
87 else sprintf(stg
+strlen(stg
), "mul%ss ", cond
[val
>>28]);
89 if(val
& 0x200000) sprintf(stg
+strlen(stg
), "mla%s ", cnd1
[val
>>28]);
90 else sprintf(stg
+strlen(stg
), "mul%s ", cnd1
[val
>>28]);
92 if(val
& 0x200000) // accumulate
93 sprintf(stg
+strlen(stg
), "%s, %s, %s, %s", regs
[(val
>>16)&15], regs
[(val
>>0)&15], regs
[(val
>>8)&15], regs
[(val
>>12)&15]);
95 sprintf(stg
+strlen(stg
), "%s, %s, %s", regs
[(val
>>16)&15], regs
[(val
>>0)&15], regs
[(val
>>8)&15]);
99 if(val
& 0x100000) // set condition flags
100 if(val
& 0x200000) // accumulate
101 if(val
& 0x400000) sprintf(stg
+strlen(stg
), "smlal%ss ", cond
[val
>>28]);
102 else sprintf(stg
+strlen(stg
), "umlal%ss ", cond
[val
>>28]);
104 if(val
& 0x400000) sprintf(stg
+strlen(stg
), "smull%ss ", cond
[val
>>28]);
105 else sprintf(stg
+strlen(stg
), "umull%ss ", cond
[val
>>28]);
108 if(val
& 0x400000) sprintf(stg
+strlen(stg
), "smlal%s ", cond
[val
>>28]);
109 else sprintf(stg
+strlen(stg
), "umlal%s ", cond
[val
>>28]);
111 if(val
& 0x400000) sprintf(stg
+strlen(stg
), "smull%s ", cond
[val
>>28]);
112 else sprintf(stg
+strlen(stg
), "umull%s ", cond
[val
>>28]);
114 sprintf(stg
+strlen(stg
), "%s, %s, %s, %s", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[(val
>>0)&15], regs
[(val
>>8)&15]);
118 void halfword_stg(char *stg
, ULONG val
)
120 ULONG off
= ((val
>>4) & 0xf0) + (val
& 0x0f);
122 if(val
& 0x100000) sprintf(stg
+strlen(stg
), "ldr%s", cond
[val
>>28]);
123 else sprintf(stg
+strlen(stg
), "str%s", cond
[val
>>28]);
125 switch((val
>>5) & 3) // SWP, HW, SB, SH
127 case 0: sprintf(stg
+strlen(stg
), "error: SWP"); break;
128 case 1: sprintf(stg
+strlen(stg
), "h "); break;
129 case 2: sprintf(stg
+strlen(stg
), "sb "); break;
130 case 3: sprintf(stg
+strlen(stg
), "sh "); break;
133 if(val
& 0x400000) // immidiate offset
134 if(val
& 0x1000000) // pre index
135 if(val
& 0x200000) // write back
136 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s, "FRMT
"]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
137 else sprintf(stg
+strlen(stg
), "%s, [%s, -"FRMT
"]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
139 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s, "FRMT
"]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
140 else sprintf(stg
+strlen(stg
), "%s, [%s, -"FRMT
"]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
142 if(val
& 0x200000) // write back
143 sprintf(stg
+strlen(stg
), "error 'write back' on post indexed");
145 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s], "FRMT
, regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
146 else sprintf(stg
+strlen(stg
), "%s, [%s], -"FRMT
, regs
[(val
>>12)&15], regs
[(val
>>16)&15], off
);
148 if(val
& 0x1000000) // pre index
149 if(val
& 0x200000) // write back
150 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s, %s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
151 else sprintf(stg
+strlen(stg
), "%s, [%s, -%s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
153 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s, %s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
154 else sprintf(stg
+strlen(stg
), "%s, [%s, -%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
156 if(val
& 0x200000) // write back
157 sprintf(stg
+strlen(stg
), "error 'write back' on post indexed");
159 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "%s, [%s], %s", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
160 else sprintf(stg
+strlen(stg
), "%s, [%s], -%s", regs
[(val
>>12)&15], regs
[(val
>>16)&15], regs
[val
&15]);
163 void branch_stg(char *stg
, ULONG val
, ULONG pos
)
165 ULONG off
= pos
+ (((int32_t)val
<< 8) >> 6) + 8;
167 if((val
& 0x0ffffff0) == 0x012fff10) // bx instruction
168 { sprintf(stg
+strlen(stg
), "bx%s %s", cond
[val
>>28], regs
[val
&15]); }
171 if(((val
>>24)&15) == 10) sprintf(stg
+strlen(stg
), "b%s ", cond
[val
>>28]);
172 else sprintf(stg
+strlen(stg
), "bl%s ", cond
[val
>>28]);
174 sprintf(stg
+strlen(stg
), "0x%x", off
);
178 void opcode_stg(char *stg
, ULONG val
, ULONG off
)
182 char *st
= stg
+ strlen(stg
);
184 if(((val
& 0x0ffffff0) == 0x012fff10) && (val
& 16))
185 { branch_stg(stg
, val
, off
); return; }
186 else if(((val
& 0x0f000000) == 0x00000000) && ((val
& 0xf0) == 0x90))
187 { multiply_stg(stg
, val
); return; }
188 else if(((val
& 0x0f000000) <= 0x01000000) && ((val
& 0x90) == 0x90) && ((val
& 0xf0) > 0x90) && ((val
& 0x01200000) != 0x00200000))
189 { halfword_stg(stg
, val
); return; }
191 sprintf(stg
+strlen(stg
), "%s%s%s ", opcd
[(val
>>21) & 15], cond
[val
>>28], setc
[(val
>>20) & 31]?"s":" ");
193 des
= (val
>>12) & 15;
194 op1
= (val
>>16) & 15;
196 if(val
& 0x2000000) // immidiate
198 off
= (ULONG
)((uint64_t)(val
&0xff) << (32 - 2 * ((val
>> 8) & 15))) | ((val
&0xff) >> 2 * ((val
>> 8) & 15));
199 sprintf(op2
, FRMT
" ", off
);
203 if(val
& 16) // shift type
204 sprintf(op2
, SHFTFRMR
, regs
[val
&15], shfts
[(val
>>5)&3], regs
[(val
>>8)&15]);
207 sprintf(op2
, SHFTFRMC
, regs
[val
&15], shfts
[(val
>>5)&3], (val
>>7) & 31);
209 sprintf(op2
, "%s ", regs
[val
&15]);
212 switch((val
>>21) & 15)
214 case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: case 12:
215 case 14: sprintf(stg
+strlen(stg
), "%s, %s, %s", regs
[des
], regs
[op1
], op2
); break;
217 case 8: case 9: case 10:
218 case 11: if(val
& 0x100000) // set status
219 sprintf(stg
+strlen(stg
), "%s, %s", regs
[op1
], op2
); // standard TEQ,TST,CMP,CMN
221 { //special MRS/MSR opcodes
222 if((((val
>>23) & 31) == 2) && ((val
& 0x3f0fff) == 0x0f0000))
223 { sprintf(st
, "mrs%s %s, %s", cnd1
[val
>>28], regs
[des
], val
&0x400000?"SPSR_xx":"CPSR"); }
225 if((((val
>>23) & 31) == 2) && ((val
& 0x30fff0) == 0x20f000))
226 { sprintf(st
, "msr%s %s, %s", cnd1
[val
>>28], val
&0x400000?"SPSR_xx":"CPSR", regs
[val
&15]); }
228 if((((val
>>23) & 31) == 6) && ((val
& 0x30f000) == 0x20f000))
229 { sprintf(st
, "msr%s %s, %s", cnd1
[val
>>28], val
&0x400000?"SPSR_xx":"CPSR_cf", op2
); }
231 if((((val
>>23) & 31) == 2) && ((val
& 0x300ff0) == 0x000090))
232 { sprintf(st
, "swp%s%s %s, %s, [%s]", val
&0x400000?"b":"", cnd1
[val
>>28], regs
[(val
>>12)&15], regs
[val
&15], regs
[(val
>>16)&15]); }
234 { sprintf(stg
+strlen(stg
), "??????????????"); }
237 case 15: sprintf(stg
+strlen(stg
), "%s, %s", regs
[des
], op2
); break;
241 void opcode_cop(char *stg
, ULONG val
, ULONG off
)
244 int opcode1
= (val
>> 21) & 0x7;
245 int CRn
= (val
>> 16) & 0xf;
246 int Rd
= (val
>> 12) & 0xf;
247 int cp_num
= (val
>> 8) & 0xf;
248 int opcode2
= (val
>> 5) & 0x7;
252 // ee073f5e mcr 15, 0, r3, cr7, cr14, {2}
260 opcode1
= (val
>> 21) & 0x7;
261 CRn
= (val
>> 16) & 0xf;
262 Rd
= (val
>> 12) & 0xf;
263 cp_num
= (val
>> 8) & 0xf;
264 opcode2
= (val
>> 5) & 0x7;
267 sprintf(stg
+strlen(stg
), "%s%s %d, %d, r%d, cr%d, cr%d, {%d}", op
, cnd1
[val
>>28], cp_num
, opcode1
, Rd
, CRn
, CRm
, opcode2
);
271 opcode1
= (val
>> 20) & 0xf;
272 CRn
= (val
>> 16) & 0xf;
273 Rd
= (val
>> 12) & 0xf;
274 cp_num
= (val
>> 8) & 0xf;
275 opcode2
= (val
>> 5) & 0x7;
278 sprintf(stg
+strlen(stg
), "%s%s %d, %d, cr%d, cr%d, cr%d, {%d}", op
, cnd1
[val
>>28], cp_num
, opcode1
, Rd
, CRn
, CRm
, opcode2
);
284 void single_data(char *stg
, ULONG val
)
288 if(((val
& 0x0e000000) == 0x06000000) && (val
& 16))
289 { sprintf(stg
+strlen(stg
), "undef%s", cond
[val
>>28]);
294 if(val
& 0x100000) sprintf(stg
+strlen(stg
), "ldr%sb ", cond
[val
>>28]);
295 else sprintf(stg
+strlen(stg
), "str%sb ", cond
[val
>>28]);
297 if(val
& 0x100000) sprintf(stg
+strlen(stg
), "ldr%s ", cnd1
[val
>>28]);
298 else sprintf(stg
+strlen(stg
), "str%s ", cnd1
[val
>>28]);
300 if(val
& 0x2000000) {// reg offset
301 if(val
& 16) // shift type
302 sprintf(op2
, "error: reg defined shift");
305 sprintf(op2
, SHFTFRMC
, regs
[val
&15], shfts
[(val
>>5)&3], (val
>>7) & 31);
307 sprintf(op2
, "%s", regs
[val
&15]);
310 if(val
& 0x2000000) // reg offset
311 if(val
& 0x1000000) // pre index
312 if(val
& 0x800000) // up offset (+)
313 if(val
& 0x200000) // write back
314 sprintf(stg
+strlen(stg
), "%s, [%s, %s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
316 sprintf(stg
+strlen(stg
), "%s, [%s, %s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
318 if(val
& 0x200000) // write back
319 sprintf(stg
+strlen(stg
), "%s, [%s, -%s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
321 sprintf(stg
+strlen(stg
), "%s, [%s, -%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
323 if(val
& 0x200000) // write back
324 sprintf(stg
+strlen(stg
), "error 'write back' set");
326 if(val
& 0x800000) // up offset (+)
327 sprintf(stg
+strlen(stg
), "%s, [%s], %s", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
329 sprintf(stg
+strlen(stg
), "%s, [%s], -%s", regs
[(val
>>12)&15], regs
[(val
>>16)&15], op2
);
331 if(val
& 0x1000000) // pre index
332 if(val
& 0x800000) // up offset (+)
333 if(val
& 0x200000) // write back
334 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s, "FRMT
"]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
335 else sprintf(stg
+strlen(stg
), "%s, [%s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
337 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s, "FRMT
"]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
338 else sprintf(stg
+strlen(stg
), "%s, [%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
340 if(val
& 0x200000) // write back
341 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s, -"FRMT
"]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
342 else sprintf(stg
+strlen(stg
), "%s, [%s]!", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
344 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s, -"FRMT
"]", regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
345 else sprintf(stg
+strlen(stg
), "%s, [%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
347 if(val
& 0x200000) // write back
348 sprintf(stg
+strlen(stg
), "error 'write back' set");
350 if(val
& 0x800000) // up offset (+)
351 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s], "FRMT
, regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
352 else sprintf(stg
+strlen(stg
), "%s, [%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
354 if(val
& 0xfff) sprintf(stg
+strlen(stg
), "%s, [%s], -"FRMT
, regs
[(val
>>12)&15], regs
[(val
>>16)&15], val
& 0xfff);
355 else sprintf(stg
+strlen(stg
), "%s, [%s]", regs
[(val
>>12)&15], regs
[(val
>>16)&15]);
358 void block_data(char *stg
, ULONG val
)
366 sprintf(lst
+strlen(lst
), "%s, ", regs
[i
]);
367 strcpy(lst
+strlen(lst
)-2, "}");
369 if(val
& 0x400000) // load psr or force user mode
370 strcpy(lst
+strlen(lst
), "^");
373 if(val
& 0x100000) // load
374 if(val
& 0x1000000) // pre offset
375 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "ldm%sib ", cond
[val
>>28]);
376 else sprintf(stg
+strlen(stg
), "ldm%sdb ", cond
[val
>>28]);
378 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "ldm%sia ", cond
[val
>>28]);
379 else sprintf(stg
+strlen(stg
), "ldm%sda ", cond
[val
>>28]);
382 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "stm%sib ", cond
[val
>>28]);
383 else sprintf(stg
+strlen(stg
), "stm%sdb ", cond
[val
>>28]);
385 if(val
& 0x800000) sprintf(stg
+strlen(stg
), "stm%sia ", cond
[val
>>28]);
386 else sprintf(stg
+strlen(stg
), "stm%sda ", cond
[val
>>28]);
390 case 0: sprintf(stg
+strlen(stg
), "%s, %s", regs
[(val
>>16)&15], lst
); break;
391 case 1: sprintf(stg
+strlen(stg
), "%s!, %s", regs
[(val
>>16)&15], lst
); break;
392 case 2: sprintf(stg
+strlen(stg
), "%s, %s", regs
[(val
>>16)&15], lst
); break;
393 case 3: sprintf(stg
+strlen(stg
), "%s!, %s", regs
[(val
>>16)&15], lst
); break;
397 void dis_asm(ULONG off
, ULONG val
, char *stg
)
399 sprintf(stg
, "%6x: %08x ", off
, val
);
401 switch((val
>> 24) & 15)
406 case 3: opcode_stg(stg
, val
, off
); break;
410 case 7: single_data(stg
, val
); break;
412 case 9: block_data(stg
, val
); break;
414 case 11: branch_stg(stg
, val
, off
); break;
416 case 13: sprintf(stg
+strlen(stg
), "cop%s", cnd1
[val
>>28]); break;
417 case 14: opcode_cop(stg
, val
, off
); break;
418 case 15: sprintf(stg
+strlen(stg
), "swi%s", cnd1
[val
>>28]); break;