/* Instruction printing code for the ARM Copyright 1994, 1995, 1996, 1997, 1998, 1999, 2000, 2001, 2002 Free Software Foundation, Inc. Contributed by Richard Earnshaw (rwe@pegasus.esprit.ec.org) Modification by James G. Smith (jsmith@cygnus.co.uk) This file is part of libopcodes. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. */ /* Modified to fit into the qtools framework. The main differences are: * * - The disassembly function returns a string instead of writing it to a * file stream. * * - All the references to the struct "disassemble_info" have been removed. * * - A set of enums for the thumb opcodes have been defined, along with a * "decode()" function that maps a thumb instruction to an opcode enum. * * - Eliminated uses of the special characters ', `, and ? from the * thumb_opcodes[] table so that we can easily specify separate opcodes * for distinct instructions. */ #include <stdio.h> #include <stdlib.h> #include <string.h> #include <inttypes.h> #include "opcode.h" struct thumb_opcode { unsigned short value, mask; /* recognise instruction if (op&mask)==value */ Opcode opcode; const char * assembler; /* how to disassemble this instruction */ }; /* format of the assembler string : %% % %<bitfield>d print the bitfield in decimal %<bitfield>x print the bitfield in hex %<bitfield>X print the bitfield as 1 hex digit without leading "0x" %<bitfield>r print as an ARM register %<bitfield>f print a floating point constant if >7 else a floating point register %<code>y print a single precision VFP reg. Codes: 0=>Sm, 1=>Sd, 2=>Sn, 3=>multi-list, 4=>Sm pair %<code>z print a double precision VFP reg Codes: 0=>Dm, 1=>Dd, 2=>Dn, 3=>multi-list %c print condition code (always bits 28-31) %P print floating point precision in arithmetic insn %Q print floating point precision in ldf/stf insn %R print floating point rounding mode %<bitnum>'c print specified char iff bit is one %<bitnum>`c print specified char iff bit is zero %<bitnum>?ab print a if bit is one else print b %p print 'p' iff bits 12-15 are 15 %t print 't' iff bit 21 set and bit 24 clear %o print operand2 (immediate or register + shift) %a print address for ldr/str instruction %s print address for ldr/str halfword/signextend instruction %b print branch destination %B print arm BLX(1) destination %A print address for ldc/stc/ldf/stf instruction %m print register mask for ldm/stm instruction %C print the PSR sub type. %F print the COUNT field of a LFM/SFM instruction. Thumb specific format options: %D print Thumb register (bits 0..2 as high number if bit 7 set) %S print Thumb register (bits 3..5 as high number if bit 6 set) %<bitfield>I print bitfield as a signed decimal (top bit of range being the sign bit) %M print Thumb register mask %N print Thumb register mask (with LR) %O print Thumb register mask (with PC) %T print Thumb condition code (always bits 8-11) %I print cirrus signed shift immediate: bits 0..3|4..6 %<bitfield>B print Thumb branch destination (signed displacement) %<bitfield>W print (bitfield * 4) as a decimal %<bitfield>H print (bitfield * 2) as a decimal %<bitfield>a print (bitfield * 4) as a pc-rel offset + decoded symbol */ static struct thumb_opcode thumb_opcodes[] = { /* Thumb instructions. */ /* ARM V5 ISA extends Thumb. */ {0xbe00, 0xff00, OP_THUMB_BKPT, "bkpt\t%0-7x"}, {0x4780, 0xff87, OP_THUMB_BLX, "blx\t%3-6r"}, /* note: 4 bit register number. */ /* Format 5 instructions do not update the PSR. */ {0x1C00, 0xFFC0, OP_THUMB_MOV, "mov\t%0-2r, %3-5r"}, /* Format 4. */ {0x4000, 0xFFC0, OP_THUMB_AND, "and\t%0-2r, %3-5r"}, {0x4040, 0xFFC0, OP_THUMB_EOR, "eor\t%0-2r, %3-5r"}, {0x4080, 0xFFC0, OP_THUMB_LSL, "lsl\t%0-2r, %3-5r"}, {0x40C0, 0xFFC0, OP_THUMB_LSR, "lsr\t%0-2r, %3-5r"}, {0x4100, 0xFFC0, OP_THUMB_ASR, "asr\t%0-2r, %3-5r"}, {0x4140, 0xFFC0, OP_THUMB_ADC, "adc\t%0-2r, %3-5r"}, {0x4180, 0xFFC0, OP_THUMB_SBC, "sbc\t%0-2r, %3-5r"}, {0x41C0, 0xFFC0, OP_THUMB_ROR, "ror\t%0-2r, %3-5r"}, {0x4200, 0xFFC0, OP_THUMB_TST, "tst\t%0-2r, %3-5r"}, {0x4240, 0xFFC0, OP_THUMB_NEG, "neg\t%0-2r, %3-5r"}, {0x4280, 0xFFC0, OP_THUMB_CMP, "cmp\t%0-2r, %3-5r"}, {0x42C0, 0xFFC0, OP_THUMB_CMN, "cmn\t%0-2r, %3-5r"}, {0x4300, 0xFFC0, OP_THUMB_ORR, "orr\t%0-2r, %3-5r"}, {0x4340, 0xFFC0, OP_THUMB_MUL, "mul\t%0-2r, %3-5r"}, {0x4380, 0xFFC0, OP_THUMB_BIC, "bic\t%0-2r, %3-5r"}, {0x43C0, 0xFFC0, OP_THUMB_MVN, "mvn\t%0-2r, %3-5r"}, /* format 13 */ {0xB000, 0xFF80, OP_THUMB_ADD, "add\tsp, #%0-6W"}, {0xB080, 0xFF80, OP_THUMB_SUB, "sub\tsp, #%0-6W"}, /* format 5 */ {0x4700, 0xFF80, OP_THUMB_BX, "bx\t%S"}, {0x4400, 0xFF00, OP_THUMB_ADD, "add\t%D, %S"}, {0x4500, 0xFF00, OP_THUMB_CMP, "cmp\t%D, %S"}, {0x4600, 0xFF00, OP_THUMB_MOV, "mov\t%D, %S"}, /* format 14 */ {0xB400, 0xFE00, OP_THUMB_PUSH, "push\t%N"}, {0xBC00, 0xFE00, OP_THUMB_POP, "pop\t%O"}, /* format 2 */ {0x1800, 0xFE00, OP_THUMB_ADD, "add\t%0-2r, %3-5r, %6-8r"}, {0x1A00, 0xFE00, OP_THUMB_SUB, "sub\t%0-2r, %3-5r, %6-8r"}, {0x1C00, 0xFE00, OP_THUMB_ADD, "add\t%0-2r, %3-5r, #%6-8d"}, {0x1E00, 0xFE00, OP_THUMB_SUB, "sub\t%0-2r, %3-5r, #%6-8d"}, /* format 8 */ {0x5200, 0xFE00, OP_THUMB_STRH, "strh\t%0-2r, [%3-5r, %6-8r]"}, {0x5A00, 0xFE00, OP_THUMB_LDRH, "ldrh\t%0-2r, [%3-5r, %6-8r]"}, {0x5600, 0xFE00, OP_THUMB_LDRSB, "ldrsb\t%0-2r, [%3-5r, %6-8r]"}, {0x5E00, 0xFE00, OP_THUMB_LDRSH, "ldrsh\t%0-2r, [%3-5r, %6-8r]"}, /* format 7 */ {0x5000, 0xFE00, OP_THUMB_STR, "str\t%0-2r, [%3-5r, %6-8r]"}, {0x5400, 0xFE00, OP_THUMB_STRB, "strb\t%0-2r, [%3-5r, %6-8r]"}, {0x5800, 0xFE00, OP_THUMB_LDR, "ldr\t%0-2r, [%3-5r, %6-8r]"}, {0x5C00, 0xFE00, OP_THUMB_LDRB, "ldrb\t%0-2r, [%3-5r, %6-8r]"}, /* format 1 */ {0x0000, 0xF800, OP_THUMB_LSL, "lsl\t%0-2r, %3-5r, #%6-10d"}, {0x0800, 0xF800, OP_THUMB_LSR, "lsr\t%0-2r, %3-5r, #%6-10d"}, {0x1000, 0xF800, OP_THUMB_ASR, "asr\t%0-2r, %3-5r, #%6-10d"}, /* format 3 */ {0x2000, 0xF800, OP_THUMB_MOV, "mov\t%8-10r, #%0-7d"}, {0x2800, 0xF800, OP_THUMB_CMP, "cmp\t%8-10r, #%0-7d"}, {0x3000, 0xF800, OP_THUMB_ADD, "add\t%8-10r, #%0-7d"}, {0x3800, 0xF800, OP_THUMB_SUB, "sub\t%8-10r, #%0-7d"}, /* format 6 */ /* TODO: Disassemble PC relative "LDR rD,=<symbolic>" */ {0x4800, 0xF800, OP_THUMB_LDR, "ldr\t%8-10r, [pc, #%0-7W]\t(%0-7a)"}, /* format 9 */ {0x6000, 0xF800, OP_THUMB_STR, "str\t%0-2r, [%3-5r, #%6-10W]"}, {0x6800, 0xF800, OP_THUMB_LDR, "ldr\t%0-2r, [%3-5r, #%6-10W]"}, {0x7000, 0xF800, OP_THUMB_STRB, "strb\t%0-2r, [%3-5r, #%6-10d]"}, {0x7800, 0xF800, OP_THUMB_LDRB, "ldrb\t%0-2r, [%3-5r, #%6-10d]"}, /* format 10 */ {0x8000, 0xF800, OP_THUMB_STRH, "strh\t%0-2r, [%3-5r, #%6-10H]"}, {0x8800, 0xF800, OP_THUMB_LDRH, "ldrh\t%0-2r, [%3-5r, #%6-10H]"}, /* format 11 */ {0x9000, 0xF800, OP_THUMB_STR, "str\t%8-10r, [sp, #%0-7W]"}, {0x9800, 0xF800, OP_THUMB_LDR, "ldr\t%8-10r, [sp, #%0-7W]"}, /* format 12 */ {0xA000, 0xF800, OP_THUMB_ADD, "add\t%8-10r, pc, #%0-7W\t(adr %8-10r,%0-7a)"}, {0xA800, 0xF800, OP_THUMB_ADD, "add\t%8-10r, sp, #%0-7W"}, /* format 15 */ {0xC000, 0xF800, OP_THUMB_STMIA, "stmia\t%8-10r!,%M"}, {0xC800, 0xF800, OP_THUMB_LDMIA, "ldmia\t%8-10r!,%M"}, /* format 18 */ {0xE000, 0xF800, OP_THUMB_B, "b\t%0-10B"}, /* format 19 */ /* special processing required in disassembler */ {0xF000, 0xF800, OP_THUMB_BL, ""}, {0xF800, 0xF800, OP_THUMB_BL, "second half of BL instruction %0-15x"}, {0xE800, 0xF800, OP_THUMB_BLX, "second half of BLX instruction %0-15x"}, /* format 16 */ {0xD000, 0xFF00, OP_THUMB_B, "beq\t%0-7B"}, {0xD100, 0xFF00, OP_THUMB_B, "bne\t%0-7B"}, {0xD200, 0xFF00, OP_THUMB_B, "bcs\t%0-7B"}, {0xD300, 0xFF00, OP_THUMB_B, "bcc\t%0-7B"}, {0xD400, 0xFF00, OP_THUMB_B, "bmi\t%0-7B"}, {0xD500, 0xFF00, OP_THUMB_B, "bpl\t%0-7B"}, {0xD600, 0xFF00, OP_THUMB_B, "bvs\t%0-7B"}, {0xD700, 0xFF00, OP_THUMB_B, "bvc\t%0-7B"}, {0xD800, 0xFF00, OP_THUMB_B, "bhi\t%0-7B"}, {0xD900, 0xFF00, OP_THUMB_B, "bls\t%0-7B"}, {0xDA00, 0xFF00, OP_THUMB_B, "bge\t%0-7B"}, {0xDB00, 0xFF00, OP_THUMB_B, "blt\t%0-7B"}, {0xDC00, 0xFF00, OP_THUMB_B, "bgt\t%0-7B"}, {0xDD00, 0xFF00, OP_THUMB_B, "ble\t%0-7B"}, /* format 17 */ {0xDE00, 0xFF00, OP_THUMB_UNDEFINED, "undefined"}, {0xDF00, 0xFF00, OP_THUMB_SWI, "swi\t%0-7d"}, /* format 9 */ {0x6000, 0xF800, OP_THUMB_STR, "str\t%0-2r, [%3-5r, #%6-10W]"}, {0x6800, 0xF800, OP_THUMB_LDR, "ldr\t%0-2r, [%3-5r, #%6-10W]"}, {0x7000, 0xF800, OP_THUMB_STRB, "strb\t%0-2r, [%3-5r, #%6-10d]"}, {0x7800, 0xF800, OP_THUMB_LDRB, "ldrb\t%0-2r, [%3-5r, #%6-10d]"}, /* the rest */ {0x0000, 0x0000, OP_THUMB_UNDEFINED, "undefined instruction %0-15x"}, {0x0000, 0x0000, OP_END, 0} }; #define BDISP23(x,y) ((((((x) & 0x07ff) << 11) | ((y) & 0x07ff)) \ ^ 0x200000) - 0x200000) /* 23bit */ static const char * arm_conditional[] = {"eq", "ne", "cs", "cc", "mi", "pl", "vs", "vc", "hi", "ls", "ge", "lt", "gt", "le", "", "nv"}; typedef struct { const char * name; const char * description; const char * reg_names[16]; } arm_regname; static arm_regname regnames[] = { { "raw" , "Select raw register names", { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15"}}, { "gcc", "Select register names used by GCC", { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "sl", "fp", "ip", "sp", "lr", "pc" }}, { "std", "Select register names used in ARM's ISA documentation", { "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r10", "r11", "r12", "sp", "lr", "pc" }}, { "apcs", "Select register names used in the APCS", { "a1", "a2", "a3", "a4", "v1", "v2", "v3", "v4", "v5", "v6", "sl", "fp", "ip", "sp", "lr", "pc" }}, { "atpcs", "Select register names used in the ATPCS", { "a1", "a2", "a3", "a4", "v1", "v2", "v3", "v4", "v5", "v6", "v7", "v8", "IP", "SP", "LR", "PC" }}, { "special-atpcs", "Select special register names used in the ATPCS", { "a1", "a2", "a3", "a4", "v1", "v2", "v3", "WR", "v5", "SB", "SL", "FP", "IP", "SP", "LR", "PC" }} }; /* Default to STD register name set. */ static unsigned int regname_selected = 2; #define NUM_ARM_REGNAMES NUM_ELEM (regnames) #define arm_regnames regnames[regname_selected].reg_names Opcode decode_insn_thumb(uint32_t given) { struct thumb_opcode * insn; for (insn = thumb_opcodes; insn->assembler; insn++) { if ((given & insn->mask) == insn->value) return insn->opcode; } return OP_THUMB_UNDEFINED; } // Generates the disassembly string for the thumb instruction "insn1". // If "insn1" is a BL or BLX instruction that is the first of two Thumb // instructions, then insn2 is the second of two instructions. Otherwise, // insn2 is ignored. char *disasm_insn_thumb(uint32_t pc, uint32_t insn1, uint32_t insn2, char *result) { struct thumb_opcode * insn; static char buf[80]; char *ptr; uint32_t addr; int len; if (result == NULL) result = buf; ptr = result; for (insn = thumb_opcodes; insn->assembler; insn++) { if ((insn1 & insn->mask) != insn->value) continue; const char * c = insn->assembler; /* Special processing for Thumb 2-instruction BL sequence: */ if (!*c) { /* Check for empty (not NULL) assembler string. */ uint32_t offset; offset = BDISP23 (insn1, insn2); offset = offset * 2 + pc + 4; if ((insn2 & 0x1000) == 0) { len = sprintf(ptr, "blx\t"); offset &= 0xfffffffc; } else { len = sprintf(ptr, "bl\t"); } ptr += len; sprintf(ptr, "0x%x", offset); return result; } insn1 &= 0xffff; for (; *c; c++) { if (*c != '%') { len = sprintf(ptr, "%c", *c); ptr += len; continue; } int domaskpc = 0; int domasklr = 0; switch (*++c) { case '%': len = sprintf(ptr, "%%"); ptr += len; break; case 'S': { uint32_t reg; reg = (insn1 >> 3) & 0x7; if (insn1 & (1 << 6)) reg += 8; len = sprintf(ptr, "%s", arm_regnames[reg]); ptr += len; break; } case 'D': { uint32_t reg; reg = insn1 & 0x7; if (insn1 & (1 << 7)) reg += 8; len = sprintf(ptr, "%s", arm_regnames[reg]); ptr += len; break; } case 'T': len = sprintf(ptr, "%s", arm_conditional [(insn1 >> 8) & 0xf]); ptr += len; break; case 'N': if (insn1 & (1 << 8)) domasklr = 1; /* Fall through. */ case 'O': if (*c == 'O' && (insn1 & (1 << 8))) domaskpc = 1; /* Fall through. */ case 'M': { int started = 0; int reg; len = sprintf(ptr, "{"); ptr += len; /* It would be nice if we could spot ranges, and generate the rS-rE format: */ for (reg = 0; (reg < 8); reg++) if ((insn1 & (1 << reg)) != 0) { if (started) { len = sprintf(ptr, ", "); ptr += len; } started = 1; len = sprintf(ptr, "%s", arm_regnames[reg]); ptr += len; } if (domasklr) { if (started) { len = sprintf(ptr, ", "); ptr += len; } started = 1; len = sprintf(ptr, arm_regnames[14] /* "lr" */); ptr += len; } if (domaskpc) { if (started) { len = sprintf(ptr, ", "); ptr += len; } len = sprintf(ptr, arm_regnames[15] /* "pc" */); ptr += len; } len = sprintf(ptr, "}"); ptr += len; break; } case '0': case '1': case '2': case '3': case '4': case '5': case '6': case '7': case '8': case '9': { int bitstart = *c++ - '0'; int bitend = 0; while (*c >= '0' && *c <= '9') bitstart = (bitstart * 10) + *c++ - '0'; switch (*c) { case '-': { uint32_t reg; c++; while (*c >= '0' && *c <= '9') bitend = (bitend * 10) + *c++ - '0'; if (!bitend) abort (); reg = insn1 >> bitstart; reg &= (2 << (bitend - bitstart)) - 1; switch (*c) { case 'r': len = sprintf(ptr, "%s", arm_regnames[reg]); break; case 'd': len = sprintf(ptr, "%d", reg); break; case 'H': len = sprintf(ptr, "%d", reg << 1); break; case 'W': len = sprintf(ptr, "%d", reg << 2); break; case 'a': /* PC-relative address -- the bottom two bits of the address are dropped before the calculation. */ addr = ((pc + 4) & ~3) + (reg << 2); len = sprintf(ptr, "0x%x", addr); break; case 'x': len = sprintf(ptr, "0x%04x", reg); break; case 'I': reg = ((reg ^ (1 << bitend)) - (1 << bitend)); len = sprintf(ptr, "%d", reg); break; case 'B': reg = ((reg ^ (1 << bitend)) - (1 << bitend)); addr = reg * 2 + pc + 4; len = sprintf(ptr, "0x%x", addr); break; default: abort (); } ptr += len; break; } case '\'': c++; if ((insn1 & (1 << bitstart)) != 0) { len = sprintf(ptr, "%c", *c); ptr += len; } break; case '?': ++c; if ((insn1 & (1 << bitstart)) != 0) len = sprintf(ptr, "%c", *c++); else len = sprintf(ptr, "%c", *++c); ptr += len; break; default: abort (); } break; } default: abort (); } } return result; } /* No match. */ abort (); }