1/* $NetBSD: disassem.c,v 1.14 2003/03/27 16:58:36 mycroft Exp $ */ 2 3/*- 4 * Copyright (c) 1996 Mark Brinicombe. 5 * Copyright (c) 1996 Brini. 6 * 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. All advertising materials mentioning features or use of this software 18 * must display the following acknowledgement: 19 * This product includes software developed by Brini. 20 * 4. The name of the company nor the name of the author may be used to 21 * endorse or promote products derived from this software without specific 22 * prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY BRINI ``AS IS'' AND ANY EXPRESS OR IMPLIED 25 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 26 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 27 * IN NO EVENT SHALL BRINI OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, 28 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 29 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 30 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 34 * SUCH DAMAGE. 35 * 36 * RiscBSD kernel project 37 * 38 * db_disasm.c 39 * 40 * Kernel disassembler 41 * 42 * Created : 10/02/96 43 * 44 * Structured after the sparc/sparc/db_disasm.c by David S. Miller & 45 * Paul Kranenburg 46 * 47 * This code is not complete. Not all instructions are disassembled. 48 */ 49 50#include <sys/cdefs.h> 51//__FBSDID("$FreeBSD: /repoman/r/ncvs/src/sys/arm/arm/disassem.c,v 1.2 2005/01/05 21:58:47 imp Exp $"); 52#include <sys/param.h> 53#include <stdio.h> 54 55#include "disassem.h" 56#include "armreg.h" 57//#include <ddb/ddb.h> 58 59/* 60 * General instruction format 61 * 62 * insn[cc][mod] [operands] 63 * 64 * Those fields with an uppercase format code indicate that the field 65 * follows directly after the instruction before the separator i.e. 66 * they modify the instruction rather than just being an operand to 67 * the instruction. The only exception is the writeback flag which 68 * follows a operand. 69 * 70 * 71 * 2 - print Operand 2 of a data processing instruction 72 * d - destination register (bits 12-15) 73 * n - n register (bits 16-19) 74 * s - s register (bits 8-11) 75 * o - indirect register rn (bits 16-19) (used by swap) 76 * m - m register (bits 0-3) 77 * a - address operand of ldr/str instruction 78 * e - address operand of ldrh/strh instruction 79 * l - register list for ldm/stm instruction 80 * f - 1st fp operand (register) (bits 12-14) 81 * g - 2nd fp operand (register) (bits 16-18) 82 * h - 3rd fp operand (register/immediate) (bits 0-4) 83 * j - xtb rotate literal (bits 10-11) 84 * i - bfx lsb literal (bits 7-11) 85 * w - bfx width literal (bits 16-20) 86 * b - branch address 87 * t - thumb branch address (bits 24, 0-23) 88 * k - breakpoint comment (bits 0-3, 8-19) 89 * X - block transfer type 90 * Y - block transfer type (r13 base) 91 * c - comment field bits(0-23) 92 * p - saved or current status register 93 * F - PSR transfer fields 94 * D - destination-is-r15 (P) flag on TST, TEQ, CMP, CMN 95 * L - co-processor transfer size 96 * S - set status flag 97 * P - fp precision 98 * Q - fp precision (for ldf/stf) 99 * R - fp rounding 100 * v - co-processor data transfer registers + addressing mode 101 * W - writeback flag 102 * x - instruction in hex 103 * # - co-processor number 104 * y - co-processor data processing registers 105 * z - co-processor register transfer registers 106 */ 107 108struct arm32_insn { 109 u_int mask; 110 u_int pattern; 111 char* name; 112 char* format; 113}; 114 115static const struct arm32_insn arm32_i[] = { 116 { 0x0fffffff, 0x0ff00000, "imb", "c" }, /* Before swi */ 117 { 0x0fffffff, 0x0ff00001, "imbrange", "c" }, /* Before swi */ 118 { 0x0f000000, 0x0f000000, "swi", "c" }, 119 { 0xfe000000, 0xfa000000, "blx", "t" }, /* Before b and bl */ 120 { 0x0f000000, 0x0a000000, "b", "b" }, 121 { 0x0f000000, 0x0b000000, "bl", "b" }, 122 { 0x0fe000f0, 0x00000090, "mul", "Snms" }, 123 { 0x0fe000f0, 0x00200090, "mla", "Snmsd" }, 124 { 0x0fe000f0, 0x00800090, "umull", "Sdnms" }, 125 { 0x0fe000f0, 0x00c00090, "smull", "Sdnms" }, 126 { 0x0fe000f0, 0x00a00090, "umlal", "Sdnms" }, 127 { 0x0fe000f0, 0x00e00090, "smlal", "Sdnms" }, 128 { 0x0fff03f0, 0x06cf0070, "uxtb16", "dmj" }, 129 { 0x0fe00070, 0x07e00050, "ubfx", "dmiw" }, 130 { 0x0d700000, 0x04200000, "strt", "daW" }, 131 { 0x0d700000, 0x04300000, "ldrt", "daW" }, 132 { 0x0d700000, 0x04600000, "strbt", "daW" }, 133 { 0x0d700000, 0x04700000, "ldrbt", "daW" }, 134 { 0x0c500000, 0x04000000, "str", "daW" }, 135 { 0x0c500000, 0x04100000, "ldr", "daW" }, 136 { 0x0c500000, 0x04400000, "strb", "daW" }, 137 { 0x0c500000, 0x04500000, "ldrb", "daW" }, 138 { 0x0e1f0000, 0x080d0000, "stm", "YnWl" },/* separate out r13 base */ 139 { 0x0e1f0000, 0x081d0000, "ldm", "YnWl" },/* separate out r13 base */ 140 { 0x0e100000, 0x08000000, "stm", "XnWl" }, 141 { 0x0e100000, 0x08100000, "ldm", "XnWl" }, 142 { 0x0e1000f0, 0x00100090, "ldrb", "deW" }, 143 { 0x0e1000f0, 0x00000090, "strb", "deW" }, 144 { 0x0e1000f0, 0x001000d0, "ldrsb", "deW" }, 145 { 0x0e1000f0, 0x001000b0, "ldrh", "deW" }, 146 { 0x0e1000f0, 0x000000b0, "strh", "deW" }, 147 { 0x0e1000f0, 0x001000f0, "ldrsh", "deW" }, 148 { 0x0f200090, 0x00200090, "und", "x" }, /* Before data processing */ 149 { 0x0e1000d0, 0x000000d0, "und", "x" }, /* Before data processing */ 150 { 0x0ff00ff0, 0x01000090, "swp", "dmo" }, 151 { 0x0ff00ff0, 0x01400090, "swpb", "dmo" }, 152 { 0x0fbf0fff, 0x010f0000, "mrs", "dp" }, /* Before data processing */ 153 { 0x0fb0fff0, 0x0120f000, "msr", "pFm" },/* Before data processing */ 154 { 0x0fb0f000, 0x0320f000, "msr", "pF2" },/* Before data processing */ 155 { 0x0ffffff0, 0x012fff10, "bx", "m" }, 156 { 0x0fff0ff0, 0x016f0f10, "clz", "dm" }, 157 { 0x0ffffff0, 0x012fff30, "blx", "m" }, 158 { 0xfff000f0, 0xe1200070, "bkpt", "k" }, 159 { 0x0de00000, 0x00000000, "and", "Sdn2" }, 160 { 0x0de00000, 0x00200000, "eor", "Sdn2" }, 161 { 0x0de00000, 0x00400000, "sub", "Sdn2" }, 162 { 0x0de00000, 0x00600000, "rsb", "Sdn2" }, 163 { 0x0de00000, 0x00800000, "add", "Sdn2" }, 164 { 0x0de00000, 0x00a00000, "adc", "Sdn2" }, 165 { 0x0de00000, 0x00c00000, "sbc", "Sdn2" }, 166 { 0x0de00000, 0x00e00000, "rsc", "Sdn2" }, 167 { 0x0df00000, 0x01100000, "tst", "Dn2" }, 168 { 0x0df00000, 0x01300000, "teq", "Dn2" }, 169 { 0x0df00000, 0x01500000, "cmp", "Dn2" }, 170 { 0x0df00000, 0x01700000, "cmn", "Dn2" }, 171 { 0x0de00000, 0x01800000, "orr", "Sdn2" }, 172 { 0x0de00000, 0x01a00000, "mov", "Sd2" }, 173 { 0x0de00000, 0x01c00000, "bic", "Sdn2" }, 174 { 0x0de00000, 0x01e00000, "mvn", "Sd2" }, 175 { 0x0ff08f10, 0x0e000100, "adf", "PRfgh" }, 176 { 0x0ff08f10, 0x0e100100, "muf", "PRfgh" }, 177 { 0x0ff08f10, 0x0e200100, "suf", "PRfgh" }, 178 { 0x0ff08f10, 0x0e300100, "rsf", "PRfgh" }, 179 { 0x0ff08f10, 0x0e400100, "dvf", "PRfgh" }, 180 { 0x0ff08f10, 0x0e500100, "rdf", "PRfgh" }, 181 { 0x0ff08f10, 0x0e600100, "pow", "PRfgh" }, 182 { 0x0ff08f10, 0x0e700100, "rpw", "PRfgh" }, 183 { 0x0ff08f10, 0x0e800100, "rmf", "PRfgh" }, 184 { 0x0ff08f10, 0x0e900100, "fml", "PRfgh" }, 185 { 0x0ff08f10, 0x0ea00100, "fdv", "PRfgh" }, 186 { 0x0ff08f10, 0x0eb00100, "frd", "PRfgh" }, 187 { 0x0ff08f10, 0x0ec00100, "pol", "PRfgh" }, 188 { 0x0f008f10, 0x0e000100, "fpbop", "PRfgh" }, 189 { 0x0ff08f10, 0x0e008100, "mvf", "PRfh" }, 190 { 0x0ff08f10, 0x0e108100, "mnf", "PRfh" }, 191 { 0x0ff08f10, 0x0e208100, "abs", "PRfh" }, 192 { 0x0ff08f10, 0x0e308100, "rnd", "PRfh" }, 193 { 0x0ff08f10, 0x0e408100, "sqt", "PRfh" }, 194 { 0x0ff08f10, 0x0e508100, "log", "PRfh" }, 195 { 0x0ff08f10, 0x0e608100, "lgn", "PRfh" }, 196 { 0x0ff08f10, 0x0e708100, "exp", "PRfh" }, 197 { 0x0ff08f10, 0x0e808100, "sin", "PRfh" }, 198 { 0x0ff08f10, 0x0e908100, "cos", "PRfh" }, 199 { 0x0ff08f10, 0x0ea08100, "tan", "PRfh" }, 200 { 0x0ff08f10, 0x0eb08100, "asn", "PRfh" }, 201 { 0x0ff08f10, 0x0ec08100, "acs", "PRfh" }, 202 { 0x0ff08f10, 0x0ed08100, "atn", "PRfh" }, 203 { 0x0f008f10, 0x0e008100, "fpuop", "PRfh" }, 204 { 0x0e100f00, 0x0c000100, "stf", "QLv" }, 205 { 0x0e100f00, 0x0c100100, "ldf", "QLv" }, 206 { 0x0ff00f10, 0x0e000110, "flt", "PRgd" }, 207 { 0x0ff00f10, 0x0e100110, "fix", "PRdh" }, 208 { 0x0ff00f10, 0x0e200110, "wfs", "d" }, 209 { 0x0ff00f10, 0x0e300110, "rfs", "d" }, 210 { 0x0ff00f10, 0x0e400110, "wfc", "d" }, 211 { 0x0ff00f10, 0x0e500110, "rfc", "d" }, 212 { 0x0ff0ff10, 0x0e90f110, "cmf", "PRgh" }, 213 { 0x0ff0ff10, 0x0eb0f110, "cnf", "PRgh" }, 214 { 0x0ff0ff10, 0x0ed0f110, "cmfe", "PRgh" }, 215 { 0x0ff0ff10, 0x0ef0f110, "cnfe", "PRgh" }, 216 { 0xff100010, 0xfe000010, "mcr2", "#z" }, 217 { 0x0f100010, 0x0e000010, "mcr", "#z" }, 218 { 0xff100010, 0xfe100010, "mrc2", "#z" }, 219 { 0x0f100010, 0x0e100010, "mrc", "#z" }, 220 { 0xff000010, 0xfe000000, "cdp2", "#y" }, 221 { 0x0f000010, 0x0e000000, "cdp", "#y" }, 222 { 0xfe100090, 0xfc100000, "ldc2", "L#v" }, 223 { 0x0e100090, 0x0c100000, "ldc", "L#v" }, 224 { 0xfe100090, 0xfc000000, "stc2", "L#v" }, 225 { 0x0e100090, 0x0c000000, "stc", "L#v" }, 226 { 0xf550f000, 0xf550f000, "pld", "ne" }, 227 { 0x0ff00ff0, 0x01000050, "qaad", "dmn" }, 228 { 0x0ff00ff0, 0x01400050, "qdaad", "dmn" }, 229 { 0x0ff00ff0, 0x01600050, "qdsub", "dmn" }, 230 { 0x0ff00ff0, 0x01200050, "dsub", "dmn" }, 231 { 0x0ff000f0, 0x01000080, "smlabb", "nmsd" }, // d & n inverted!! 232 { 0x0ff000f0, 0x010000a0, "smlatb", "nmsd" }, // d & n inverted!! 233 { 0x0ff000f0, 0x010000c0, "smlabt", "nmsd" }, // d & n inverted!! 234 { 0x0ff000f0, 0x010000e0, "smlatt", "nmsd" }, // d & n inverted!! 235 { 0x0ff000f0, 0x01400080, "smlalbb","ndms" }, // d & n inverted!! 236 { 0x0ff000f0, 0x014000a0, "smlaltb","ndms" }, // d & n inverted!! 237 { 0x0ff000f0, 0x014000c0, "smlalbt","ndms" }, // d & n inverted!! 238 { 0x0ff000f0, 0x014000e0, "smlaltt","ndms" }, // d & n inverted!! 239 { 0x0ff000f0, 0x01200080, "smlawb", "nmsd" }, // d & n inverted!! 240 { 0x0ff0f0f0, 0x012000a0, "smulwb","nms" }, // d & n inverted!! 241 { 0x0ff000f0, 0x012000c0, "smlawt", "nmsd" }, // d & n inverted!! 242 { 0x0ff0f0f0, 0x012000e0, "smulwt","nms" }, // d & n inverted!! 243 { 0x0ff0f0f0, 0x01600080, "smulbb","nms" }, // d & n inverted!! 244 { 0x0ff0f0f0, 0x016000a0, "smultb","nms" }, // d & n inverted!! 245 { 0x0ff0f0f0, 0x016000c0, "smulbt","nms" }, // d & n inverted!! 246 { 0x0ff0f0f0, 0x016000e0, "smultt","nms" }, // d & n inverted!! 247 { 0x00000000, 0x00000000, NULL, NULL } 248}; 249 250static char const arm32_insn_conditions[][4] = { 251 "eq", "ne", "cs", "cc", 252 "mi", "pl", "vs", "vc", 253 "hi", "ls", "ge", "lt", 254 "gt", "le", "", "nv" 255}; 256 257static char const insn_block_transfers[][4] = { 258 "da", "ia", "db", "ib" 259}; 260 261static char const insn_stack_block_transfers[][4] = { 262 "ed", "ea", "fd", "fa" 263}; 264 265static char const op_shifts[][4] = { 266 "lsl", "lsr", "asr", "ror" 267}; 268 269static char const insn_fpa_rounding[][2] = { 270 "", "p", "m", "z" 271}; 272 273static char const insn_fpa_precision[][2] = { 274 "s", "d", "e", "p" 275}; 276 277static char const insn_fpaconstants[][8] = { 278 "0.0", "1.0", "2.0", "3.0", 279 "4.0", "5.0", "0.5", "10.0" 280}; 281 282#define insn_condition(x) arm32_insn_conditions[((x) >> 28) & 0x0f] 283#define insn_blktrans(x) insn_block_transfers[((x) >> 23) & 3] 284#define insn_stkblktrans(x) insn_stack_block_transfers[(3*(((x) >> 20)&1))^(((x) >> 23)&3)] 285#define op2_shift(x) op_shifts[((x) >> 5) & 3] 286#define insn_fparnd(x) insn_fpa_rounding[((x) >> 5) & 0x03] 287#define insn_fpaprec(x) insn_fpa_precision[((((x) >> 18) & 2)|((x) >> 7)) & 1] 288#define insn_fpaprect(x) insn_fpa_precision[((((x) >> 21) & 2)|((x) >> 15)) & 1] 289#define insn_fpaimm(x) insn_fpaconstants[(x) & 0x07] 290 291/* Local prototypes */ 292static void disasm_register_shift(const disasm_interface_t *di, u_int insn); 293static void disasm_print_reglist(const disasm_interface_t *di, u_int insn); 294static void disasm_insn_ldrstr(const disasm_interface_t *di, u_int insn, 295 u_int loc); 296static void disasm_insn_ldrhstrh(const disasm_interface_t *di, u_int insn, 297 u_int loc); 298static void disasm_insn_ldcstc(const disasm_interface_t *di, u_int insn, 299 u_int loc); 300static u_int disassemble_readword(u_int address); 301static void disassemble_printaddr(u_int address); 302 303u_int 304disasm(const disasm_interface_t *di, u_int loc, int __unused altfmt) 305{ 306 const struct arm32_insn *i_ptr = &arm32_i[0]; 307 u_int insn = di->di_readword(loc); 308 int matchp = 0; 309 int branch; 310 char* f_ptr; 311 int fmt = 0; 312 313/* di->di_printf("loc=%08x insn=%08x : ", loc, insn);*/ 314 315 while (i_ptr->name) { 316 if ((insn & i_ptr->mask) == i_ptr->pattern) { 317 matchp = 1; 318 break; 319 } 320 i_ptr++; 321 } 322 323 if (!matchp) { 324 di->di_printf("und%s\t%08x\n", insn_condition(insn), insn); 325 return(loc + INSN_SIZE); 326 } 327 328 /* If instruction forces condition code, don't print it. */ 329 if ((i_ptr->mask & 0xf0000000) == 0xf0000000) 330 di->di_printf("%s", i_ptr->name); 331 else 332 di->di_printf("%s%s", i_ptr->name, insn_condition(insn)); 333 334 f_ptr = i_ptr->format; 335 336 /* Insert tab if there are no instruction modifiers */ 337 338 if (*(f_ptr) < 'A' || *(f_ptr) > 'Z') { 339 ++fmt; 340 di->di_printf("\t"); 341 } 342 343 while (*f_ptr) { 344 switch (*f_ptr) { 345 /* 2 - print Operand 2 of a data processing instruction */ 346 case '2': 347 if (insn & 0x02000000) { 348 int rotate= ((insn >> 7) & 0x1e); 349 350 di->di_printf("#0x%08x", 351 (insn & 0xff) << (32 - rotate) | 352 (insn & 0xff) >> rotate); 353 } else { 354 disasm_register_shift(di, insn); 355 } 356 break; 357 /* d - destination register (bits 12-15) */ 358 case 'd': 359 di->di_printf("r%d", ((insn >> 12) & 0x0f)); 360 break; 361 /* D - insert 'p' if Rd is R15 */ 362 case 'D': 363 if (((insn >> 12) & 0x0f) == 15) 364 di->di_printf("p"); 365 break; 366 /* n - n register (bits 16-19) */ 367 case 'n': 368 di->di_printf("r%d", ((insn >> 16) & 0x0f)); 369 break; 370 /* s - s register (bits 8-11) */ 371 case 's': 372 di->di_printf("r%d", ((insn >> 8) & 0x0f)); 373 break; 374 /* o - indirect register rn (bits 16-19) (used by swap) */ 375 case 'o': 376 di->di_printf("[r%d]", ((insn >> 16) & 0x0f)); 377 break; 378 /* m - m register (bits 0-4) */ 379 case 'm': 380 di->di_printf("r%d", ((insn >> 0) & 0x0f)); 381 break; 382 /* a - address operand of ldr/str instruction */ 383 case 'a': 384 disasm_insn_ldrstr(di, insn, loc); 385 break; 386 /* e - address operand of ldrh/strh instruction */ 387 case 'e': 388 disasm_insn_ldrhstrh(di, insn, loc); 389 break; 390 /* l - register list for ldm/stm instruction */ 391 case 'l': 392 disasm_print_reglist(di, insn); 393 break; 394 /* f - 1st fp operand (register) (bits 12-14) */ 395 case 'f': 396 di->di_printf("f%d", (insn >> 12) & 7); 397 break; 398 /* g - 2nd fp operand (register) (bits 16-18) */ 399 case 'g': 400 di->di_printf("f%d", (insn >> 16) & 7); 401 break; 402 /* h - 3rd fp operand (register/immediate) (bits 0-4) */ 403 case 'h': 404 if (insn & (1 << 3)) 405 di->di_printf("#%s", insn_fpaimm(insn)); 406 else 407 di->di_printf("f%d", insn & 7); 408 break; 409 /* j - xtb rotate literal (bits 10-11) */ 410 case 'j': 411 di->di_printf("ror #%d", ((insn >> 10) & 3) << 3); 412 break; 413 /* i - bfx lsb literal (bits 7-11) */ 414 case 'i': 415 di->di_printf("#%d", (insn >> 7) & 31); 416 break; 417 /* w - bfx width literal (bits 16-20) */ 418 case 'w': 419 di->di_printf("#%d", 1 + ((insn >> 16) & 31)); 420 break; 421 /* b - branch address */ 422 case 'b': 423 branch = ((insn << 2) & 0x03ffffff); 424 if (branch & 0x02000000) 425 branch |= 0xfc000000; 426 di->di_printaddr(loc + 8 + branch); 427 break; 428 /* t - blx address */ 429 case 't': 430 branch = ((insn << 2) & 0x03ffffff) | 431 (insn >> 23 & 0x00000002); 432 if (branch & 0x02000000) 433 branch |= 0xfc000000; 434 di->di_printaddr(loc + 8 + branch); 435 break; 436 /* X - block transfer type */ 437 case 'X': 438 di->di_printf("%s", insn_blktrans(insn)); 439 break; 440 /* Y - block transfer type (r13 base) */ 441 case 'Y': 442 di->di_printf("%s", insn_stkblktrans(insn)); 443 break; 444 /* c - comment field bits(0-23) */ 445 case 'c': 446 di->di_printf("0x%08x", (insn & 0x00ffffff)); 447 break; 448 /* k - breakpoint comment (bits 0-3, 8-19) */ 449 case 'k': 450 di->di_printf("0x%04x", 451 (insn & 0x000fff00) >> 4 | (insn & 0x0000000f)); 452 break; 453 /* p - saved or current status register */ 454 case 'p': 455 if (insn & 0x00400000) 456 di->di_printf("spsr"); 457 else 458 di->di_printf("cpsr"); 459 break; 460 /* F - PSR transfer fields */ 461 case 'F': 462 di->di_printf("_"); 463 if (insn & (1 << 16)) 464 di->di_printf("c"); 465 if (insn & (1 << 17)) 466 di->di_printf("x"); 467 if (insn & (1 << 18)) 468 di->di_printf("s"); 469 if (insn & (1 << 19)) 470 di->di_printf("f"); 471 break; 472 /* B - byte transfer flag */ 473 case 'B': 474 if (insn & 0x00400000) 475 di->di_printf("b"); 476 break; 477 /* L - co-processor transfer size */ 478 case 'L': 479 if (insn & (1 << 22)) 480 di->di_printf("l"); 481 break; 482 /* S - set status flag */ 483 case 'S': 484 if (insn & 0x00100000) 485 di->di_printf("s"); 486 break; 487 /* P - fp precision */ 488 case 'P': 489 di->di_printf("%s", insn_fpaprec(insn)); 490 break; 491 /* Q - fp precision (for ldf/stf) */ 492 case 'Q': 493 break; 494 /* R - fp rounding */ 495 case 'R': 496 di->di_printf("%s", insn_fparnd(insn)); 497 break; 498 /* W - writeback flag */ 499 case 'W': 500 if (insn & (1 << 21)) 501 di->di_printf("!"); 502 break; 503 /* # - co-processor number */ 504 case '#': 505 di->di_printf("p%d", (insn >> 8) & 0x0f); 506 break; 507 /* v - co-processor data transfer registers+addressing mode */ 508 case 'v': 509 disasm_insn_ldcstc(di, insn, loc); 510 break; 511 /* x - instruction in hex */ 512 case 'x': 513 di->di_printf("0x%08x", insn); 514 break; 515 /* y - co-processor data processing registers */ 516 case 'y': 517 di->di_printf("%d, ", (insn >> 20) & 0x0f); 518 519 di->di_printf("c%d, c%d, c%d", (insn >> 12) & 0x0f, 520 (insn >> 16) & 0x0f, insn & 0x0f); 521 522 di->di_printf(", %d", (insn >> 5) & 0x07); 523 break; 524 /* z - co-processor register transfer registers */ 525 case 'z': 526 di->di_printf("%d, ", (insn >> 21) & 0x07); 527 di->di_printf("r%d, c%d, c%d, %d", 528 (insn >> 12) & 0x0f, (insn >> 16) & 0x0f, 529 insn & 0x0f, (insn >> 5) & 0x07); 530 531/* if (((insn >> 5) & 0x07) != 0) 532 di->di_printf(", %d", (insn >> 5) & 0x07);*/ 533 break; 534 default: 535 di->di_printf("[%c - unknown]", *f_ptr); 536 break; 537 } 538 if (*(f_ptr+1) >= 'A' && *(f_ptr+1) <= 'Z') 539 ++f_ptr; 540 else if (*(++f_ptr)) { 541 ++fmt; 542 if (fmt == 1) 543 di->di_printf("\t"); 544 else 545 di->di_printf(", "); 546 } 547 }; 548 549 di->di_printf("\n"); 550 551 return(loc + INSN_SIZE); 552} 553 554 555static void 556disasm_register_shift(const disasm_interface_t *di, u_int insn) 557{ 558 di->di_printf("r%d", (insn & 0x0f)); 559 if ((insn & 0x00000ff0) == 0) 560 ; 561 else if ((insn & 0x00000ff0) == 0x00000060) 562 di->di_printf(", rrx"); 563 else { 564 if (insn & 0x10) 565 di->di_printf(", %s r%d", op2_shift(insn), 566 (insn >> 8) & 0x0f); 567 else 568 di->di_printf(", %s #%d", op2_shift(insn), 569 (insn >> 7) & 0x1f); 570 } 571} 572 573 574static void 575disasm_print_reglist(const disasm_interface_t *di, u_int insn) 576{ 577 int loop; 578 int start; 579 int comma; 580 581 di->di_printf("{"); 582 start = -1; 583 comma = 0; 584 585 for (loop = 0; loop < 17; ++loop) { 586 if (start != -1) { 587 if (loop == 16 || !(insn & (1 << loop))) { 588 if (comma) 589 di->di_printf(", "); 590 else 591 comma = 1; 592 if (start == loop - 1) 593 di->di_printf("r%d", start); 594 else 595 di->di_printf("r%d-r%d", start, loop - 1); 596 start = -1; 597 } 598 } else { 599 if (insn & (1 << loop)) 600 start = loop; 601 } 602 } 603 di->di_printf("}"); 604 605 if (insn & (1 << 22)) 606 di->di_printf("^"); 607} 608 609static void 610disasm_insn_ldrstr(const disasm_interface_t *di, u_int insn, u_int loc) 611{ 612 int offset; 613 614 offset = insn & 0xfff; 615 if ((insn & 0x032f0000) == 0x010f0000) { 616 /* rA = pc, immediate index */ 617 if (insn & 0x00800000) 618 loc += offset; 619 else 620 loc -= offset; 621 di->di_printaddr(loc + 8); 622 } else { 623 di->di_printf("[r%d", (insn >> 16) & 0x0f); 624 if ((insn & 0x03000fff) != 0x01000000) { 625 di->di_printf("%s, ", (insn & (1 << 24)) ? "" : "]"); 626 if (!(insn & 0x00800000)) 627 di->di_printf("-"); 628 if (insn & (1 << 25)) 629 disasm_register_shift(di, insn); 630 else 631 di->di_printf("#0x%03x", offset); 632 } 633 if (insn & (1 << 24)) 634 di->di_printf("]"); 635 } 636} 637 638static void 639disasm_insn_ldrhstrh(const disasm_interface_t *di, u_int insn, u_int loc) 640{ 641 int offset; 642 643 offset = ((insn & 0xf00) >> 4) | (insn & 0xf); 644 if ((insn & 0x004f0000) == 0x004f0000) { 645 /* rA = pc, immediate index */ 646 if (insn & 0x00800000) 647 loc += offset; 648 else 649 loc -= offset; 650 di->di_printaddr(loc + 8); 651 } else { 652 di->di_printf("[r%d", (insn >> 16) & 0x0f); 653 if ((insn & 0x01400f0f) != 0x01400000) { 654 di->di_printf("%s, ", (insn & (1 << 24)) ? "" : "]"); 655 if (!(insn & 0x00800000)) 656 di->di_printf("-"); 657 if (insn & (1 << 22)) 658 di->di_printf("#0x%02x", offset); 659 else 660 di->di_printf("r%d", (insn & 0x0f)); 661 } 662 if (insn & (1 << 24)) 663 di->di_printf("]"); 664 } 665} 666 667static void 668disasm_insn_ldcstc(const disasm_interface_t *di, u_int insn, u_int __unused loc) 669{ 670 if (((insn >> 8) & 0xf) == 1) 671 di->di_printf("f%d, ", (insn >> 12) & 0x07); 672 else 673 di->di_printf("c%d, ", (insn >> 12) & 0x0f); 674 675 di->di_printf("[r%d", (insn >> 16) & 0x0f); 676 677 di->di_printf("%s, ", (insn & (1 << 24)) ? "" : "]"); 678 679 if (!(insn & (1 << 23))) 680 di->di_printf("-"); 681 682 di->di_printf("#0x%03x", (insn & 0xff) << 2); 683 684 if (insn & (1 << 24)) 685 di->di_printf("]"); 686 687 if (insn & (1 << 21)) 688 di->di_printf("!"); 689} 690 691static u_int 692disassemble_readword(u_int address) 693{ 694 return(*((u_int *)address)); 695} 696 697static void 698disassemble_printaddr(u_int address) 699{ 700 printf("0x%08x", address); 701} 702 703static const disasm_interface_t disassemble_di = { 704 disassemble_readword, disassemble_printaddr, printf 705}; 706 707void 708disassemble(u_int address) 709{ 710 711 (void)disasm(&disassemble_di, address, 0); 712} 713 714/* End of disassem.c */ 715