summaryrefslogtreecommitdiffstats
path: root/utils/disassembler
diff options
context:
space:
mode:
authorRafaël Carré <rafael.carre@gmail.com>2010-06-17 16:59:51 +0000
committerRafaël Carré <rafael.carre@gmail.com>2010-06-17 16:59:51 +0000
commitc0bd4173aa3b8f49153964d5a3ff311fc7d59651 (patch)
treefafdfbecb21383141a61bbd8c744386772da390b /utils/disassembler
parent3d2b1cfa6e3307d3a97a055776ea342cd62f683e (diff)
downloadrockbox-c0bd4173aa3b8f49153964d5a3ff311fc7d59651.tar.gz
rockbox-c0bd4173aa3b8f49153964d5a3ff311fc7d59651.tar.bz2
rockbox-c0bd4173aa3b8f49153964d5a3ff311fc7d59651.zip
Make sure files which aren't windows-specific use \n line endings only
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@26893 a1c6a512-1295-4272-9138-f99709370657
Diffstat (limited to 'utils/disassembler')
-rw-r--r--utils/disassembler/arm/disasm_arm.c846
-rw-r--r--utils/disassembler/arm/main.c264
2 files changed, 555 insertions, 555 deletions
diff --git a/utils/disassembler/arm/disasm_arm.c b/utils/disassembler/arm/disasm_arm.c
index b23c6b0355..14e72d9583 100644
--- a/utils/disassembler/arm/disasm_arm.c
+++ b/utils/disassembler/arm/disasm_arm.c
@@ -1,423 +1,423 @@
-#include <stdio.h>
-#include <string.h>
-#include <stdint.h>
-
-#define ULONG uint32_t
-#define UCHAR uint8_t
-
-#define FRMT "0x%x" // "0x%x"
-#define SHFTFRMC "%s %s #%d" // "%s %s %d"
-#define SHFTFRMR "%s %s %s" // "%s %s %s"
-//#define FRMT "0x%x"
-//#define SHFTFRMC "%s %s %d"
-//#define SHFTFRMR "%s %s %s"
-
-char *cond[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", "", "nv" };
-char *cnd1[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", " ", "nv" };
-char *opcd[16] = {"and","eor","sub","rsb","add","adc","sbc","rsc","tst","teq","cmp","cmn","orr","mov","bic","mvn" };
-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 };
-char *regs[16] = { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "sl", "fp", "ip", "sp", "lr", "pc" };
-
-char *shfts[4] = { "lsl", "lsr", "asr", "ror" };
-
-/*
-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
-Cond 0 0 I ---Opcode--- S |----Rn----- ----Rd----- --------Operand 2-------- Data Processing /PSR Transfer
-Cond 0 0 0 0 | 0 0 A S |----Rd----- ----Rn----- ---Rs---- 1 0 0 1 --Rm--- Multiply
-Cond 0 0 0 0 | 1 U A S |---RdHi---- ---RdLo---- ---Rn---- 1 0 0 1 --Rm--- Multiply Long
-Cond 0 0 0 1 | 0 B 0 0 |----Rn----- ----Rd----- 0 0 0 0 1 0 0 1 --Rm--- Single Data Swap
-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
-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
-Cond 0 0 0 P | U 1 W L |----Rn----- ----Rd----- --Offset- 1 S H 1 -Offset Halfword Data Transfer: immediate offset
-Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
-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
-Cond 1 0 0 P | U S W L |----Rn----- -----------Register List------------- Block Data Transfer
-Cond 1 0 1 L | -------------------------Offset------------------------------ Branch
-Cond 1 1 0 P | U N W L |----Rn----- ----CRd---- ---CP#--- -----Offset---- Coprocessor Data Transfer
-Cond 1 1 1 0 | --CP Opc---|----CRn---- ----CRd---- ---CP#--- -CP-- 0 --CRm-- Coprocessor Data Operation
-Cond 1 1 1 0 | CP Opc L |----CRn---- ----Rd----- ---CP#--- -CP-- 1 --CRm-- Coprocessor Register Transfer
-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
-
-0x04200000
-0001 0 0 0 0 0 1 1 0 6 e 1 1 1 0 1 8
-================================================================================
-Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
-
-
-EQ 0 Z set equal
-NE 1 Z clear not equal
-CS 2 C set unsigned higher or same
-CC 3 C clear unsigned lower
-MI 4 N set negative
-PL 5 N clear positive or zero
-VS 6 V set overflow
-VC 7 V clear no overflow
-HI 8 C set and Z clear unsigned higher
-LS 9 C clear or Z set unsigned lower or same
-GE A N equals V greater or equal
-LT B N not equal to V less than
-GT C Z clear AND (N equals V) greater than
-LE D Z set OR (N not equal to V) less than or equal
-AL E (ignored) always
-
-AND 0 operand1 AND operand2
-EOR 1 operand1 EOR operand2
-SUB 2 operand1 - operand2
-RSB 3 operand2 - operand1
-ADD 4 operand1 + operand2
-ADC 5 operand1 + operand2 + carry
-SBC 6 operand1 - operand2 + carry - 1
-RSC 7 operand2 - operand1 + carry - 1
-TST 8 AND, but result is not written
-TEQ 9 as EOR, but result is not written
-CMP A as SUB, but result is not written
-CMN B as ADD, but result is not written
-ORR C operand1 OR operand2
-MOV D operand2 (operand1 is ignored)
-BIC E operand1 AND NOT operand2 (Bit clear)
-MVN F NOT operand2 (operand1 is ignored)
-*/
-
-void multiply_stg(char *stg, ULONG val)
-{
- if((val&0xc00000) == 0) // simple mul
- {
- if(val & 0x100000) // set condition flags
- if(val & 0x200000) sprintf(stg+strlen(stg), "mla%ss ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "mul%ss ", cond[val>>28]);
- else
- if(val & 0x200000) sprintf(stg+strlen(stg), "mla%s ", cnd1[val>>28]);
- else sprintf(stg+strlen(stg), "mul%s ", cnd1[val>>28]);
-
- if(val & 0x200000) // accumulate
- sprintf(stg+strlen(stg), "%s, %s, %s, %s", regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15], regs[(val>>12)&15]);
- else
- sprintf(stg+strlen(stg), "%s, %s, %s", regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15]);
- }
- else
- {
- if(val & 0x100000) // set condition flags
- if(val & 0x200000) // accumulate
- if(val & 0x400000) sprintf(stg+strlen(stg), "smlal%ss ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "umlal%ss ", cond[val>>28]);
- else
- if(val & 0x400000) sprintf(stg+strlen(stg), "smull%ss ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "umull%ss ", cond[val>>28]);
- else
- if(val & 0x200000)
- if(val & 0x400000) sprintf(stg+strlen(stg), "smlal%s ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "umlal%s ", cond[val>>28]);
- else
- if(val & 0x400000) sprintf(stg+strlen(stg), "smull%s ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "umull%s ", cond[val>>28]);
-
- sprintf(stg+strlen(stg), "%s, %s, %s, %s", regs[(val>>12)&15], regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15]);
- }
-}
-
-void halfword_stg(char *stg, ULONG val)
-{
- ULONG off = ((val>>4) & 0xf0) + (val & 0x0f);
-
- if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%s", cond[val>>28]);
- else sprintf(stg+strlen(stg), "str%s", cond[val>>28]);
-
- switch((val>>5) & 3) // SWP, HW, SB, SH
- {
- case 0: sprintf(stg+strlen(stg), "error: SWP"); break;
- case 1: sprintf(stg+strlen(stg), "h "); break;
- case 2: sprintf(stg+strlen(stg), "sb "); break;
- case 3: sprintf(stg+strlen(stg), "sh "); break;
- }
-
- if(val & 0x400000) // immidiate offset
- if(val & 0x1000000) // pre index
- if(val & 0x200000) // write back
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], off);
- else sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], off);
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], off);
- else sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], off);
- else
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "error 'write back' on post indexed");
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s], "FRMT, regs[(val>>12)&15], regs[(val>>16)&15], off);
- else sprintf(stg+strlen(stg), "%s, [%s], -"FRMT, regs[(val>>12)&15], regs[(val>>16)&15], off);
- else
- if(val & 0x1000000) // pre index
- if(val & 0x200000) // write back
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, %s]!", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
- else sprintf(stg+strlen(stg), "%s, [%s, -%s]!", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, %s]", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
- else sprintf(stg+strlen(stg), "%s, [%s, -%s]", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
- else
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "error 'write back' on post indexed");
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s], %s", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
- else sprintf(stg+strlen(stg), "%s, [%s], -%s", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
-}
-
-void branch_stg(char *stg, ULONG val, ULONG pos)
-{
- ULONG off = pos + (((int32_t)val << 8) >> 6) + 8;
-
- if((val & 0x0ffffff0) == 0x012fff10) // bx instruction
- { sprintf(stg+strlen(stg), "bx%s %s", cond[val>>28], regs[val&15]); }
- else
- {
- if(((val>>24)&15) == 10) sprintf(stg+strlen(stg), "b%s ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "bl%s ", cond[val>>28]);
-
- sprintf(stg+strlen(stg), "0x%x", off);
- }
-}
-
-void opcode_stg(char *stg, ULONG val, ULONG off)
-{
- ULONG des, op1;
- char op2[80];
- char *st = stg + strlen(stg);
-
- if(((val & 0x0ffffff0) == 0x012fff10) && (val & 16))
- { branch_stg(stg, val, off); return; }
- else if(((val & 0x0f000000) == 0x00000000) && ((val & 0xf0) == 0x90))
- { multiply_stg(stg, val); return; }
- else if(((val & 0x0f000000) <= 0x01000000) && ((val & 0x90) == 0x90) && ((val & 0xf0) > 0x90) && ((val & 0x01200000) != 0x00200000))
- { halfword_stg(stg, val); return; }
-
- sprintf(stg+strlen(stg), "%s%s%s ", opcd[(val>>21) & 15], cond[val>>28], setc[(val>>20) & 31]?"s":" ");
-
- des = (val>>12) & 15;
- op1 = (val>>16) & 15;
-
- if(val & 0x2000000) // immidiate
- {
- off = (ULONG)((uint64_t)(val&0xff) << (32 - 2 * ((val >> 8) & 15))) | ((val&0xff) >> 2 * ((val >> 8) & 15));
- sprintf(op2, FRMT" ", off);
- }
- else
- {
- if(val & 16) // shift type
- sprintf(op2, SHFTFRMR, regs[val&15], shfts[(val>>5)&3], regs[(val>>8)&15]);
- else
- if((val>>7) & 31)
- sprintf(op2, SHFTFRMC, regs[val&15], shfts[(val>>5)&3], (val>>7) & 31);
- else
- sprintf(op2, "%s ", regs[val&15]);
- }
-
- switch((val>>21) & 15)
- {
- case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: case 12:
- case 14: sprintf(stg+strlen(stg), "%s, %s, %s", regs[des], regs[op1], op2); break;
-
- case 8: case 9: case 10:
- case 11: if(val & 0x100000) // set status
- sprintf(stg+strlen(stg), "%s, %s", regs[op1], op2); // standard TEQ,TST,CMP,CMN
- else
- { //special MRS/MSR opcodes
- if((((val>>23) & 31) == 2) && ((val & 0x3f0fff) == 0x0f0000))
- { sprintf(st, "mrs%s %s, %s", cnd1[val>>28], regs[des], val&0x400000?"SPSR_xx":"CPSR"); }
- else
- if((((val>>23) & 31) == 2) && ((val & 0x30fff0) == 0x20f000))
- { sprintf(st, "msr%s %s, %s", cnd1[val>>28], val&0x400000?"SPSR_xx":"CPSR", regs[val&15]); }
- else
- if((((val>>23) & 31) == 6) && ((val & 0x30f000) == 0x20f000))
- { sprintf(st, "msr%s %s, %s", cnd1[val>>28], val&0x400000?"SPSR_xx":"CPSR_cf", op2); }
- else
- if((((val>>23) & 31) == 2) && ((val & 0x300ff0) == 0x000090))
- { 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]); }
- else
- { sprintf(stg+strlen(stg), "??????????????"); }
- } break;
- case 13:
- case 15: sprintf(stg+strlen(stg), "%s, %s", regs[des], op2); break;
- }
-}
-
-void opcode_cop(char *stg, ULONG val, ULONG off)
-{
- char* op;
- int opcode1 = (val >> 21) & 0x7;
- int CRn = (val >> 16) & 0xf;
- int Rd = (val >> 12) & 0xf;
- int cp_num = (val >> 8) & 0xf;
- int opcode2 = (val >> 5) & 0x7;
- int CRm = val & 0xf;
-
-
-// ee073f5e mcr 15, 0, r3, cr7, cr14, {2}
-
- if (val & (1<<4)) {
- if (val & (1<<20)) {
- op = "mrc";
- } else {
- op = "mcr";
- }
- opcode1 = (val >> 21) & 0x7;
- CRn = (val >> 16) & 0xf;
- Rd = (val >> 12) & 0xf;
- cp_num = (val >> 8) & 0xf;
- opcode2 = (val >> 5) & 0x7;
- CRm = val & 0xf;
-
- 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);
- } else {
- op = "cdp";
-
- opcode1 = (val >> 20) & 0xf;
- CRn = (val >> 16) & 0xf;
- Rd = (val >> 12) & 0xf;
- cp_num = (val >> 8) & 0xf;
- opcode2 = (val >> 5) & 0x7;
- CRm = val & 0xf;
-
- 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);
- }
-
-}
-
-
-void single_data(char *stg, ULONG val)
-{
- char op2[80];
-
- if(((val & 0x0e000000) == 0x06000000) && (val & 16))
- { sprintf(stg+strlen(stg), "undef%s", cond[val>>28]);
- return;
- }
-
- if(val & 0x400000)
- if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%sb ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "str%sb ", cond[val>>28]);
- else
- if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%s ", cnd1[val>>28]);
- else sprintf(stg+strlen(stg), "str%s ", cnd1[val>>28]);
-
- if(val & 0x2000000) {// reg offset
- if(val & 16) // shift type
- sprintf(op2, "error: reg defined shift");
- else
- if((val>>7) & 31)
- sprintf(op2, SHFTFRMC, regs[val&15], shfts[(val>>5)&3], (val>>7) & 31);
- else
- sprintf(op2, "%s", regs[val&15]);
- }
-
- if(val & 0x2000000) // reg offset
- if(val & 0x1000000) // pre index
- if(val & 0x800000) // up offset (+)
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "%s, [%s, %s]!", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- sprintf(stg+strlen(stg), "%s, [%s, %s]", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "%s, [%s, -%s]!", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- sprintf(stg+strlen(stg), "%s, [%s, -%s]", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "error 'write back' set");
- else
- if(val & 0x800000) // up offset (+)
- sprintf(stg+strlen(stg), "%s, [%s], %s", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- sprintf(stg+strlen(stg), "%s, [%s], -%s", regs[(val>>12)&15], regs[(val>>16)&15], op2);
- else
- if(val & 0x1000000) // pre index
- if(val & 0x800000) // up offset (+)
- if(val & 0x200000) // write back
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]!", regs[(val>>12)&15], regs[(val>>16)&15]);
- else
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
- else
- if(val & 0x200000) // write back
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]!", regs[(val>>12)&15], regs[(val>>16)&15]);
- else
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
- else
- if(val & 0x200000) // write back
- sprintf(stg+strlen(stg), "error 'write back' set");
- else
- if(val & 0x800000) // up offset (+)
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s], "FRMT, regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
- else
- if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s], -"FRMT, regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
- else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
-}
-
-void block_data(char *stg, ULONG val)
-{
- char lst[80];
- int i;
-
- strcpy(lst, "{");
- for(i=0; i<16; i++)
- if(val & (1<<i))
- sprintf(lst+strlen(lst), "%s, ", regs[i]);
- if(strlen(lst)>2)
- strcpy(lst+strlen(lst)-2, "}");
- else
- strcpy(lst+strlen(lst), "}");
-
- if(val & 0x400000) // load psr or force user mode
- strcpy(lst+strlen(lst), "^");
-
-
- if(val & 0x100000) // load
- if(val & 0x1000000) // pre offset
- if(val & 0x800000) sprintf(stg+strlen(stg), "ldm%sib ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "ldm%sdb ", cond[val>>28]);
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "ldm%sia ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "ldm%sda ", cond[val>>28]);
- else
- if(val & 0x1000000)
- if(val & 0x800000) sprintf(stg+strlen(stg), "stm%sib ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "stm%sdb ", cond[val>>28]);
- else
- if(val & 0x800000) sprintf(stg+strlen(stg), "stm%sia ", cond[val>>28]);
- else sprintf(stg+strlen(stg), "stm%sda ", cond[val>>28]);
-
- switch((val>>21)&3)
- {
- case 0: sprintf(stg+strlen(stg), "%s, %s", regs[(val>>16)&15], lst); break;
- case 1: sprintf(stg+strlen(stg), "%s!, %s", regs[(val>>16)&15], lst); break;
- case 2: sprintf(stg+strlen(stg), "%s, %s", regs[(val>>16)&15], lst); break;
- case 3: sprintf(stg+strlen(stg), "%s!, %s", regs[(val>>16)&15], lst); break;
- }
-}
-
-void dis_asm(ULONG off, ULONG val, char *stg)
-{
- sprintf(stg, "%6x: %08x ", off, val);
-
- switch((val >> 24) & 15)
- {
- case 0:
- case 1:
- case 2:
- case 3: opcode_stg(stg, val, off); break;
- case 4:
- case 5:
- case 6:
- case 7: single_data(stg, val); break;
- case 8:
- case 9: block_data(stg, val); break;
- case 10:
- case 11: branch_stg(stg, val, off); break;
- case 12:
- case 13: sprintf(stg+strlen(stg), "cop%s", cnd1[val>>28]); break;
- case 14: opcode_cop(stg, val, off); break;
- case 15: sprintf(stg+strlen(stg), "swi%s", cnd1[val>>28]); break;
- }
-}
+#include <stdio.h>
+#include <string.h>
+#include <stdint.h>
+
+#define ULONG uint32_t
+#define UCHAR uint8_t
+
+#define FRMT "0x%x" // "0x%x"
+#define SHFTFRMC "%s %s #%d" // "%s %s %d"
+#define SHFTFRMR "%s %s %s" // "%s %s %s"
+//#define FRMT "0x%x"
+//#define SHFTFRMC "%s %s %d"
+//#define SHFTFRMR "%s %s %s"
+
+char *cond[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", "", "nv" };
+char *cnd1[16] = { "eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", " ", "nv" };
+char *opcd[16] = {"and","eor","sub","rsb","add","adc","sbc","rsc","tst","teq","cmp","cmn","orr","mov","bic","mvn" };
+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 };
+char *regs[16] = { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "sl", "fp", "ip", "sp", "lr", "pc" };
+
+char *shfts[4] = { "lsl", "lsr", "asr", "ror" };
+
+/*
+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
+Cond 0 0 I ---Opcode--- S |----Rn----- ----Rd----- --------Operand 2-------- Data Processing /PSR Transfer
+Cond 0 0 0 0 | 0 0 A S |----Rd----- ----Rn----- ---Rs---- 1 0 0 1 --Rm--- Multiply
+Cond 0 0 0 0 | 1 U A S |---RdHi---- ---RdLo---- ---Rn---- 1 0 0 1 --Rm--- Multiply Long
+Cond 0 0 0 1 | 0 B 0 0 |----Rn----- ----Rd----- 0 0 0 0 1 0 0 1 --Rm--- Single Data Swap
+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
+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
+Cond 0 0 0 P | U 1 W L |----Rn----- ----Rd----- --Offset- 1 S H 1 -Offset Halfword Data Transfer: immediate offset
+Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
+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
+Cond 1 0 0 P | U S W L |----Rn----- -----------Register List------------- Block Data Transfer
+Cond 1 0 1 L | -------------------------Offset------------------------------ Branch
+Cond 1 1 0 P | U N W L |----Rn----- ----CRd---- ---CP#--- -----Offset---- Coprocessor Data Transfer
+Cond 1 1 1 0 | --CP Opc---|----CRn---- ----CRd---- ---CP#--- -CP-- 0 --CRm-- Coprocessor Data Operation
+Cond 1 1 1 0 | CP Opc L |----CRn---- ----Rd----- ---CP#--- -CP-- 1 --CRm-- Coprocessor Register Transfer
+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
+
+0x04200000
+0001 0 0 0 0 0 1 1 0 6 e 1 1 1 0 1 8
+================================================================================
+Cond 0 1 I P | U B W L |----Rn----- ----Rd----- --------Offset----------- Single Data Transfer
+
+
+EQ 0 Z set equal
+NE 1 Z clear not equal
+CS 2 C set unsigned higher or same
+CC 3 C clear unsigned lower
+MI 4 N set negative
+PL 5 N clear positive or zero
+VS 6 V set overflow
+VC 7 V clear no overflow
+HI 8 C set and Z clear unsigned higher
+LS 9 C clear or Z set unsigned lower or same
+GE A N equals V greater or equal
+LT B N not equal to V less than
+GT C Z clear AND (N equals V) greater than
+LE D Z set OR (N not equal to V) less than or equal
+AL E (ignored) always
+
+AND 0 operand1 AND operand2
+EOR 1 operand1 EOR operand2
+SUB 2 operand1 - operand2
+RSB 3 operand2 - operand1
+ADD 4 operand1 + operand2
+ADC 5 operand1 + operand2 + carry
+SBC 6 operand1 - operand2 + carry - 1
+RSC 7 operand2 - operand1 + carry - 1
+TST 8 AND, but result is not written
+TEQ 9 as EOR, but result is not written
+CMP A as SUB, but result is not written
+CMN B as ADD, but result is not written
+ORR C operand1 OR operand2
+MOV D operand2 (operand1 is ignored)
+BIC E operand1 AND NOT operand2 (Bit clear)
+MVN F NOT operand2 (operand1 is ignored)
+*/
+
+void multiply_stg(char *stg, ULONG val)
+{
+ if((val&0xc00000) == 0) // simple mul
+ {
+ if(val & 0x100000) // set condition flags
+ if(val & 0x200000) sprintf(stg+strlen(stg), "mla%ss ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "mul%ss ", cond[val>>28]);
+ else
+ if(val & 0x200000) sprintf(stg+strlen(stg), "mla%s ", cnd1[val>>28]);
+ else sprintf(stg+strlen(stg), "mul%s ", cnd1[val>>28]);
+
+ if(val & 0x200000) // accumulate
+ sprintf(stg+strlen(stg), "%s, %s, %s, %s", regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15], regs[(val>>12)&15]);
+ else
+ sprintf(stg+strlen(stg), "%s, %s, %s", regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15]);
+ }
+ else
+ {
+ if(val & 0x100000) // set condition flags
+ if(val & 0x200000) // accumulate
+ if(val & 0x400000) sprintf(stg+strlen(stg), "smlal%ss ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "umlal%ss ", cond[val>>28]);
+ else
+ if(val & 0x400000) sprintf(stg+strlen(stg), "smull%ss ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "umull%ss ", cond[val>>28]);
+ else
+ if(val & 0x200000)
+ if(val & 0x400000) sprintf(stg+strlen(stg), "smlal%s ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "umlal%s ", cond[val>>28]);
+ else
+ if(val & 0x400000) sprintf(stg+strlen(stg), "smull%s ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "umull%s ", cond[val>>28]);
+
+ sprintf(stg+strlen(stg), "%s, %s, %s, %s", regs[(val>>12)&15], regs[(val>>16)&15], regs[(val>>0)&15], regs[(val>>8)&15]);
+ }
+}
+
+void halfword_stg(char *stg, ULONG val)
+{
+ ULONG off = ((val>>4) & 0xf0) + (val & 0x0f);
+
+ if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%s", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "str%s", cond[val>>28]);
+
+ switch((val>>5) & 3) // SWP, HW, SB, SH
+ {
+ case 0: sprintf(stg+strlen(stg), "error: SWP"); break;
+ case 1: sprintf(stg+strlen(stg), "h "); break;
+ case 2: sprintf(stg+strlen(stg), "sb "); break;
+ case 3: sprintf(stg+strlen(stg), "sh "); break;
+ }
+
+ if(val & 0x400000) // immidiate offset
+ if(val & 0x1000000) // pre index
+ if(val & 0x200000) // write back
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "error 'write back' on post indexed");
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s], "FRMT, regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else sprintf(stg+strlen(stg), "%s, [%s], -"FRMT, regs[(val>>12)&15], regs[(val>>16)&15], off);
+ else
+ if(val & 0x1000000) // pre index
+ if(val & 0x200000) // write back
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, %s]!", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+ else sprintf(stg+strlen(stg), "%s, [%s, -%s]!", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s, %s]", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+ else sprintf(stg+strlen(stg), "%s, [%s, -%s]", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+ else
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "error 'write back' on post indexed");
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "%s, [%s], %s", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+ else sprintf(stg+strlen(stg), "%s, [%s], -%s", regs[(val>>12)&15], regs[(val>>16)&15], regs[val&15]);
+}
+
+void branch_stg(char *stg, ULONG val, ULONG pos)
+{
+ ULONG off = pos + (((int32_t)val << 8) >> 6) + 8;
+
+ if((val & 0x0ffffff0) == 0x012fff10) // bx instruction
+ { sprintf(stg+strlen(stg), "bx%s %s", cond[val>>28], regs[val&15]); }
+ else
+ {
+ if(((val>>24)&15) == 10) sprintf(stg+strlen(stg), "b%s ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "bl%s ", cond[val>>28]);
+
+ sprintf(stg+strlen(stg), "0x%x", off);
+ }
+}
+
+void opcode_stg(char *stg, ULONG val, ULONG off)
+{
+ ULONG des, op1;
+ char op2[80];
+ char *st = stg + strlen(stg);
+
+ if(((val & 0x0ffffff0) == 0x012fff10) && (val & 16))
+ { branch_stg(stg, val, off); return; }
+ else if(((val & 0x0f000000) == 0x00000000) && ((val & 0xf0) == 0x90))
+ { multiply_stg(stg, val); return; }
+ else if(((val & 0x0f000000) <= 0x01000000) && ((val & 0x90) == 0x90) && ((val & 0xf0) > 0x90) && ((val & 0x01200000) != 0x00200000))
+ { halfword_stg(stg, val); return; }
+
+ sprintf(stg+strlen(stg), "%s%s%s ", opcd[(val>>21) & 15], cond[val>>28], setc[(val>>20) & 31]?"s":" ");
+
+ des = (val>>12) & 15;
+ op1 = (val>>16) & 15;
+
+ if(val & 0x2000000) // immidiate
+ {
+ off = (ULONG)((uint64_t)(val&0xff) << (32 - 2 * ((val >> 8) & 15))) | ((val&0xff) >> 2 * ((val >> 8) & 15));
+ sprintf(op2, FRMT" ", off);
+ }
+ else
+ {
+ if(val & 16) // shift type
+ sprintf(op2, SHFTFRMR, regs[val&15], shfts[(val>>5)&3], regs[(val>>8)&15]);
+ else
+ if((val>>7) & 31)
+ sprintf(op2, SHFTFRMC, regs[val&15], shfts[(val>>5)&3], (val>>7) & 31);
+ else
+ sprintf(op2, "%s ", regs[val&15]);
+ }
+
+ switch((val>>21) & 15)
+ {
+ case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: case 12:
+ case 14: sprintf(stg+strlen(stg), "%s, %s, %s", regs[des], regs[op1], op2); break;
+
+ case 8: case 9: case 10:
+ case 11: if(val & 0x100000) // set status
+ sprintf(stg+strlen(stg), "%s, %s", regs[op1], op2); // standard TEQ,TST,CMP,CMN
+ else
+ { //special MRS/MSR opcodes
+ if((((val>>23) & 31) == 2) && ((val & 0x3f0fff) == 0x0f0000))
+ { sprintf(st, "mrs%s %s, %s", cnd1[val>>28], regs[des], val&0x400000?"SPSR_xx":"CPSR"); }
+ else
+ if((((val>>23) & 31) == 2) && ((val & 0x30fff0) == 0x20f000))
+ { sprintf(st, "msr%s %s, %s", cnd1[val>>28], val&0x400000?"SPSR_xx":"CPSR", regs[val&15]); }
+ else
+ if((((val>>23) & 31) == 6) && ((val & 0x30f000) == 0x20f000))
+ { sprintf(st, "msr%s %s, %s", cnd1[val>>28], val&0x400000?"SPSR_xx":"CPSR_cf", op2); }
+ else
+ if((((val>>23) & 31) == 2) && ((val & 0x300ff0) == 0x000090))
+ { 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]); }
+ else
+ { sprintf(stg+strlen(stg), "??????????????"); }
+ } break;
+ case 13:
+ case 15: sprintf(stg+strlen(stg), "%s, %s", regs[des], op2); break;
+ }
+}
+
+void opcode_cop(char *stg, ULONG val, ULONG off)
+{
+ char* op;
+ int opcode1 = (val >> 21) & 0x7;
+ int CRn = (val >> 16) & 0xf;
+ int Rd = (val >> 12) & 0xf;
+ int cp_num = (val >> 8) & 0xf;
+ int opcode2 = (val >> 5) & 0x7;
+ int CRm = val & 0xf;
+
+
+// ee073f5e mcr 15, 0, r3, cr7, cr14, {2}
+
+ if (val & (1<<4)) {
+ if (val & (1<<20)) {
+ op = "mrc";
+ } else {
+ op = "mcr";
+ }
+ opcode1 = (val >> 21) & 0x7;
+ CRn = (val >> 16) & 0xf;
+ Rd = (val >> 12) & 0xf;
+ cp_num = (val >> 8) & 0xf;
+ opcode2 = (val >> 5) & 0x7;
+ CRm = val & 0xf;
+
+ 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);
+ } else {
+ op = "cdp";
+
+ opcode1 = (val >> 20) & 0xf;
+ CRn = (val >> 16) & 0xf;
+ Rd = (val >> 12) & 0xf;
+ cp_num = (val >> 8) & 0xf;
+ opcode2 = (val >> 5) & 0x7;
+ CRm = val & 0xf;
+
+ 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);
+ }
+
+}
+
+
+void single_data(char *stg, ULONG val)
+{
+ char op2[80];
+
+ if(((val & 0x0e000000) == 0x06000000) && (val & 16))
+ { sprintf(stg+strlen(stg), "undef%s", cond[val>>28]);
+ return;
+ }
+
+ if(val & 0x400000)
+ if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%sb ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "str%sb ", cond[val>>28]);
+ else
+ if(val & 0x100000) sprintf(stg+strlen(stg), "ldr%s ", cnd1[val>>28]);
+ else sprintf(stg+strlen(stg), "str%s ", cnd1[val>>28]);
+
+ if(val & 0x2000000) {// reg offset
+ if(val & 16) // shift type
+ sprintf(op2, "error: reg defined shift");
+ else
+ if((val>>7) & 31)
+ sprintf(op2, SHFTFRMC, regs[val&15], shfts[(val>>5)&3], (val>>7) & 31);
+ else
+ sprintf(op2, "%s", regs[val&15]);
+ }
+
+ if(val & 0x2000000) // reg offset
+ if(val & 0x1000000) // pre index
+ if(val & 0x800000) // up offset (+)
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "%s, [%s, %s]!", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ sprintf(stg+strlen(stg), "%s, [%s, %s]", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "%s, [%s, -%s]!", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ sprintf(stg+strlen(stg), "%s, [%s, -%s]", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "error 'write back' set");
+ else
+ if(val & 0x800000) // up offset (+)
+ sprintf(stg+strlen(stg), "%s, [%s], %s", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ sprintf(stg+strlen(stg), "%s, [%s], -%s", regs[(val>>12)&15], regs[(val>>16)&15], op2);
+ else
+ if(val & 0x1000000) // pre index
+ if(val & 0x800000) // up offset (+)
+ if(val & 0x200000) // write back
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]!", regs[(val>>12)&15], regs[(val>>16)&15]);
+ else
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, "FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
+ else
+ if(val & 0x200000) // write back
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]!", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]!", regs[(val>>12)&15], regs[(val>>16)&15]);
+ else
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s, -"FRMT"]", regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
+ else
+ if(val & 0x200000) // write back
+ sprintf(stg+strlen(stg), "error 'write back' set");
+ else
+ if(val & 0x800000) // up offset (+)
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s], "FRMT, regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
+ else
+ if(val & 0xfff) sprintf(stg+strlen(stg), "%s, [%s], -"FRMT, regs[(val>>12)&15], regs[(val>>16)&15], val & 0xfff);
+ else sprintf(stg+strlen(stg), "%s, [%s]", regs[(val>>12)&15], regs[(val>>16)&15]);
+}
+
+void block_data(char *stg, ULONG val)
+{
+ char lst[80];
+ int i;
+
+ strcpy(lst, "{");
+ for(i=0; i<16; i++)
+ if(val & (1<<i))
+ sprintf(lst+strlen(lst), "%s, ", regs[i]);
+ if(strlen(lst)>2)
+ strcpy(lst+strlen(lst)-2, "}");
+ else
+ strcpy(lst+strlen(lst), "}");
+
+ if(val & 0x400000) // load psr or force user mode
+ strcpy(lst+strlen(lst), "^");
+
+
+ if(val & 0x100000) // load
+ if(val & 0x1000000) // pre offset
+ if(val & 0x800000) sprintf(stg+strlen(stg), "ldm%sib ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "ldm%sdb ", cond[val>>28]);
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "ldm%sia ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "ldm%sda ", cond[val>>28]);
+ else
+ if(val & 0x1000000)
+ if(val & 0x800000) sprintf(stg+strlen(stg), "stm%sib ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "stm%sdb ", cond[val>>28]);
+ else
+ if(val & 0x800000) sprintf(stg+strlen(stg), "stm%sia ", cond[val>>28]);
+ else sprintf(stg+strlen(stg), "stm%sda ", cond[val>>28]);
+
+ switch((val>>21)&3)
+ {
+ case 0: sprintf(stg+strlen(stg), "%s, %s", regs[(val>>16)&15], lst); break;
+ case 1: sprintf(stg+strlen(stg), "%s!, %s", regs[(val>>16)&15], lst); break;
+ case 2: sprintf(stg+strlen(stg), "%s, %s", regs[(val>>16)&15], lst); break;
+ case 3: sprintf(stg+strlen(stg), "%s!, %s", regs[(val>>16)&15], lst); break;
+ }
+}
+
+void dis_asm(ULONG off, ULONG val, char *stg)
+{
+ sprintf(stg, "%6x: %08x ", off, val);
+
+ switch((val >> 24) & 15)
+ {
+ case 0:
+ case 1:
+ case 2:
+ case 3: opcode_stg(stg, val, off); break;
+ case 4:
+ case 5:
+ case 6:
+ case 7: single_data(stg, val); break;
+ case 8:
+ case 9: block_data(stg, val); break;
+ case 10:
+ case 11: branch_stg(stg, val, off); break;
+ case 12:
+ case 13: sprintf(stg+strlen(stg), "cop%s", cnd1[val>>28]); break;
+ case 14: opcode_cop(stg, val, off); break;
+ case 15: sprintf(stg+strlen(stg), "swi%s", cnd1[val>>28]); break;
+ }
+}
diff --git a/utils/disassembler/arm/main.c b/utils/disassembler/arm/main.c
index 0edc633785..674696405c 100644
--- a/utils/disassembler/arm/main.c
+++ b/utils/disassembler/arm/main.c
@@ -1,132 +1,132 @@
-#include <stdio.h>
-#include <string.h>
-#include <stdlib.h>
-#include <stdint.h>
-
-#define ULONG uint32_t
-#define USHORT uint16_t
-#define UCHAR uint8_t
-
-ULONG isdata[1000000]; /* each bit defines one byte as: code=0, data=1 */
-
-extern void dis_asm(ULONG off, ULONG val, char *stg);
-
-int static inline le2int(unsigned char* buf)
-{
- int32_t res = (buf[3] << 24) | (buf[2] << 16) | (buf[1] << 8) | buf[0];
-
- return res;
-}
-
-int main(int argc, char **argv)
-{
- FILE *in, *out;
- char *ptr, stg[256];
- unsigned char buf[4];
- ULONG pos, sz, val, loop;
- int offset, offset1;
- USHORT regid;
-
- if(argc == 1 || strcmp(argv[1], "--help") == 0)
- { printf("Usage: arm_disass [input file]\n");
- printf(" disassembles input file to 'disasm.txt'\n");
- exit(-1);
- }
-
- in = fopen(argv[1], "rb");
- if(in == NULL)
- { printf("Cannot open %s", argv[1]);
- exit(-1);
- }
-
- out = fopen("disasm.txt", "w");
- if(out == NULL) exit(-1);
-
- fseek(in, 0, SEEK_END);
- sz = ftell(in);
-
- /* first loop only sets data/code tags */
- for(loop=0; loop<2; loop++)
- {
- for(pos=0; pos<sz; pos+=4)
- {
- /* clear disassembler string start */
- memset(stg, 0, 40);
- /* read next code dword */
- fseek(in, pos, SEEK_SET);
- fread(buf, 1, 4, in);
-
- val = le2int(buf);
-
- /* check for data tag set: if 1 byte out of 4 is marked => assume data */
- if((isdata[pos>>5] & (0xf << (pos & 31))) || (val & 0xffff0000) == 0)
- {
- sprintf(stg, "%6x: %08x", pos, val);
- }
- else
- {
- dis_asm(pos, val, stg);
-
- /* check for instant mov operation */
- if(memcmp(stg+17, "mov ", 4) == 0 && (ptr=strstr(stg, "0x")) != NULL)
- {
- regid = *(USHORT*)(stg+22);
-
- sscanf(ptr+2, "%x", &offset);
- if(ptr[-1] == '-')
- offset = -offset;
- }
- else
- /* check for add/sub operation */
- if((ptr=strstr(stg, "0x")) != NULL
- && (memcmp(stg+17, "add ", 4) == 0 || memcmp(stg+17, "sub ", 4) == 0))
- {
- if(regid == *(USHORT*)(stg+22) && regid == *(USHORT*)(stg+26))
- {
- sscanf(ptr+2, "%x", &offset1);
- if(ptr[-1] == '-')
- offset1 = -offset1;
-
- if(memcmp(stg+17, "add ", 4) == 0) offset += offset1;
- else offset -= offset1;
-
- /* add result to disassembler string */
- sprintf(stg+strlen(stg), " <- 0x%x", offset);
- }
- else
- regid = 0;
- }
- else
- regid = 0;
-
- /* check for const data */
- if(memcmp(stg+26, "[pc, ", 5) == 0 && (ptr=strstr(stg, "0x")) != NULL)
- {
- sscanf(ptr+2, "%x", &offset);
- if(ptr[-1] == '-')
- offset = -offset;
-
- /* add data tag */
- isdata[(pos+offset+8)>>5] |= 1 << ((pos+offset+8) & 31);
-
- /* add const data to disassembler string */
- fseek(in, pos+offset+8, SEEK_SET);
- fread(&buf, 1, 4, in);
- offset = le2int(buf);
-
- sprintf(stg+strlen(stg), " <- 0x%x", offset);
- }
- }
-
- /* remove trailing spaces */
- while(stg[strlen(stg)-1] == 32)
- stg[strlen(stg)-1] = 0;
-
- if(loop == 1)
- fprintf(out, "%s\n", stg);
- }
- }
-
- fclose(in);
- return 0;
-}
+#include <stdio.h>
+#include <string.h>
+#include <stdlib.h>
+#include <stdint.h>
+
+#define ULONG uint32_t
+#define USHORT uint16_t
+#define UCHAR uint8_t
+
+ULONG isdata[1000000]; /* each bit defines one byte as: code=0, data=1 */
+
+extern void dis_asm(ULONG off, ULONG val, char *stg);
+
+int static inline le2int(unsigned char* buf)
+{
+ int32_t res = (buf[3] << 24) | (buf[2] << 16) | (buf[1] << 8) | buf[0];
+
+ return res;
+}
+
+int main(int argc, char **argv)
+{
+ FILE *in, *out;
+ char *ptr, stg[256];
+ unsigned char buf[4];
+ ULONG pos, sz, val, loop;
+ int offset, offset1;
+ USHORT regid;
+
+ if(argc == 1 || strcmp(argv[1], "--help") == 0)
+ { printf("Usage: arm_disass [input file]\n");
+ printf(" disassembles input file to 'disasm.txt'\n");
+ exit(-1);
+ }
+
+ in = fopen(argv[1], "rb");
+ if(in == NULL)
+ { printf("Cannot open %s", argv[1]);
+ exit(-1);
+ }
+
+ out = fopen("disasm.txt", "w");
+ if(out == NULL) exit(-1);
+
+ fseek(in, 0, SEEK_END);
+ sz = ftell(in);
+
+ /* first loop only sets data/code tags */
+ for(loop=0; loop<2; loop++)
+ {
+ for(pos=0; pos<sz; pos+=4)
+ {
+ /* clear disassembler string start */
+ memset(stg, 0, 40);
+ /* read next code dword */
+ fseek(in, pos, SEEK_SET);
+ fread(buf, 1, 4, in);
+
+ val = le2int(buf);
+
+ /* check for data tag set: if 1 byte out of 4 is marked => assume data */
+ if((isdata[pos>>5] & (0xf << (pos & 31))) || (val & 0xffff0000) == 0)
+ {
+ sprintf(stg, "%6x: %08x", pos, val);
+ }
+ else
+ {
+ dis_asm(pos, val, stg);
+
+ /* check for instant mov operation */
+ if(memcmp(stg+17, "mov ", 4) == 0 && (ptr=strstr(stg, "0x")) != NULL)
+ {
+ regid = *(USHORT*)(stg+22);
+
+ sscanf(ptr+2, "%x", &offset);
+ if(ptr[-1] == '-')
+ offset = -offset;
+ }
+ else
+ /* check for add/sub operation */
+ if((ptr=strstr(stg, "0x")) != NULL
+ && (memcmp(stg+17, "add ", 4) == 0 || memcmp(stg+17, "sub ", 4) == 0))
+ {
+ if(regid == *(USHORT*)(stg+22) && regid == *(USHORT*)(stg+26))
+ {
+ sscanf(ptr+2, "%x", &offset1);
+ if(ptr[-1] == '-')
+ offset1 = -offset1;
+
+ if(memcmp(stg+17, "add ", 4) == 0) offset += offset1;
+ else offset -= offset1;
+
+ /* add result to disassembler string */
+ sprintf(stg+strlen(stg), " <- 0x%x", offset);
+ }
+ else
+ regid = 0;
+ }
+ else
+ regid = 0;
+
+ /* check for const data */
+ if(memcmp(stg+26, "[pc, ", 5) == 0 && (ptr=strstr(stg, "0x")) != NULL)
+ {
+ sscanf(ptr+2, "%x", &offset);
+ if(ptr[-1] == '-')
+ offset = -offset;
+
+ /* add data tag */
+ isdata[(pos+offset+8)>>5] |= 1 << ((pos+offset+8) & 31);
+
+ /* add const data to disassembler string */
+ fseek(in, pos+offset+8, SEEK_SET);
+ fread(&buf, 1, 4, in);
+ offset = le2int(buf);
+
+ sprintf(stg+strlen(stg), " <- 0x%x", offset);
+ }
+ }
+
+ /* remove trailing spaces */
+ while(stg[strlen(stg)-1] == 32)
+ stg[strlen(stg)-1] = 0;
+
+ if(loop == 1)
+ fprintf(out, "%s\n", stg);
+ }
+ }
+
+ fclose(in);
+ return 0;
+}