opcodes/avr-dis.c

   1 /* Disassemble AVR instructions.
   2    Copyright 1999, 2000, 2002, 2004, 2005, 2006
   3    Free Software Foundation, Inc.
   4
   5    Contributed by Denis Chertykov <denisc@overta.ru>
   6
   7    This program is free software; you can redistribute it and/or modify
   8    it under the terms of the GNU General Public License as published by
   9    the Free Software Foundation; either version 2 of the License, or
  10    (at your option) any later version.
  11
  12    This program is distributed in the hope that it will be useful,
  13    but WITHOUT ANY WARRANTY; without even the implied warranty of
  14    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15    GNU General Public License for more details.
  16
  17    You should have received a copy of the GNU General Public License
  18    along with this program; if not, write to the Free Software
  19    Foundation, Inc., 51 Franklin Street - Fifth Floor, Boston, MA 02110-1301, USA.  */
  20
  21 #include <assert.h>
  22 #include "sysdep.h"
  23 #include "dis-asm.h"
  24 #include "opintl.h"
  25 #include "libiberty.h"
  26
  27 struct avr_opcodes_s
  28 {
  29   char *name;
  30   char *constraints;
  31   char *opcode;
  32   int insn_size;                /* In words.  */
  33   int isa;
  34   unsigned int bin_opcode;
  35 };
  36
  37 #define AVR_INSN(NAME, CONSTR, OPCODE, SIZE, ISA, BIN) \
  38 {#NAME, CONSTR, OPCODE, SIZE, ISA, BIN},
  39
  40 const struct avr_opcodes_s avr_opcodes[] =
  41 {
  42   #include "opcode/avr.h"
  43   {NULL, NULL, NULL, 0, 0, 0}
  44 };
  45
  46 static int
  47 avr_operand (unsigned int insn, unsigned int insn2, unsigned int pc, int constraint,
  48              char *buf, char *comment, int regs, int *sym, bfd_vma *sym_addr)
  49 {
  50   int ok = 1;
  51   *sym = 0;
  52
  53   switch (constraint)
  54     {
  55       /* Any register operand.  */
  56     case 'r':
  57       if (regs)
  58         insn = (insn & 0xf) | ((insn & 0x0200) >> 5); /* Source register.  */
  59       else
  60         insn = (insn & 0x01f0) >> 4; /* Destination register.  */
  61
  62       sprintf (buf, "r%d", insn);
  63       break;
  64
  65     case 'd':
  66       if (regs)
  67         sprintf (buf, "r%d", 16 + (insn & 0xf));
  68       else
  69         sprintf (buf, "r%d", 16 + ((insn & 0xf0) >> 4));
  70       break;
  71
  72     case 'w':
  73       sprintf (buf, "r%d", 24 + ((insn & 0x30) >> 3));
  74       break;
  75
  76     case 'a':
  77       if (regs)
  78         sprintf (buf, "r%d", 16 + (insn & 7));
  79       else
  80         sprintf (buf, "r%d", 16 + ((insn >> 4) & 7));
  81       break;
  82
  83     case 'v':
  84       if (regs)
  85         sprintf (buf, "r%d", (insn & 0xf) * 2);
  86       else
  87         sprintf (buf, "r%d", ((insn & 0xf0) >> 3));
  88       break;
  89
  90     case 'e':
  91       {
  92         char *xyz;
  93
  94         switch (insn & 0x100f)
  95           {
  96             case 0x0000: xyz = "Z";  break;
  97             case 0x1001: xyz = "Z+"; break;
  98             case 0x1002: xyz = "-Z"; break;
  99             case 0x0008: xyz = "Y";  break;
 100             case 0x1009: xyz = "Y+"; break;
 101             case 0x100a: xyz = "-Y"; break;
 102             case 0x100c: xyz = "X";  break;
 103             case 0x100d: xyz = "X+"; break;
 104             case 0x100e: xyz = "-X"; break;
 105             default: xyz = "??"; ok = 0;
 106           }
 107         sprintf (buf, xyz);
 108
 109         if (AVR_UNDEF_P (insn))
 110           sprintf (comment, _("undefined"));
 111       }
 112       break;
 113
 114     case 'z':
 115       *buf++ = 'Z';
 116       if (insn & 0x1)
 117         *buf++ = '+';
 118       *buf = '\0';
 119       if (AVR_UNDEF_P (insn))
 120         sprintf (comment, _("undefined"));
 121       break;
 122
 123     case 'b':
 124       {
 125         unsigned int x;
 126
 127         x = (insn & 7);
 128         x |= (insn >> 7) & (3 << 3);
 129         x |= (insn >> 8) & (1 << 5);
 130
 131         if (insn & 0x8)
 132           *buf++ = 'Y';
 133         else
 134           *buf++ = 'Z';
 135         sprintf (buf, "+%d", x);
 136         sprintf (comment, "0x%02x", x);
 137       }
 138       break;
 139
 140     case 'h':
 141       *sym = 1;
 142       *sym_addr = ((((insn & 1) | ((insn & 0x1f0) >> 3)) << 16) | insn2) * 2;
 143       /* See PR binutils/2454.  Ideally we would like to display the hex
 144          value of the address only once, but this would mean recoding
 145          objdump_print_address() which would affect many targets.  */
 146       sprintf (buf, "%#lx", (unsigned long) *sym_addr);
 147       sprintf (comment, "0x");
 148
 149       break;
 150
 151     case 'L':
 152       {
 153         int rel_addr = (((insn & 0xfff) ^ 0x800) - 0x800) * 2;
 154         sprintf (buf, ".%+-8d", rel_addr);
 155         *sym = 1;
 156         *sym_addr = pc + 2 + rel_addr;
 157         sprintf (comment, "0x");
 158       }
 159       break;
 160
 161     case 'l':
 162       {
 163         int rel_addr = ((((insn >> 3) & 0x7f) ^ 0x40) - 0x40) * 2;
 164         sprintf (buf, ".%+-8d", rel_addr);
 165         *sym = 1;
 166         *sym_addr = pc + 2 + rel_addr;
 167         sprintf (comment, "0x");
 168       }
 169       break;
 170
 171     case 'i':
 172       sprintf (buf, "0x%04X", insn2);
 173       break;
 174
 175     case 'M':
 176       sprintf (buf, "0x%02X", ((insn & 0xf00) >> 4) | (insn & 0xf));
 177       sprintf (comment, "%d", ((insn & 0xf00) >> 4) | (insn & 0xf));
 178       break;
 179
 180     case 'n':
 181       sprintf (buf, "??");
 182       fprintf (stderr, _("Internal disassembler error"));
 183       ok = 0;
 184       break;
 185
 186     case 'K':
 187       {
 188         unsigned int x;
 189
 190         x = (insn & 0xf) | ((insn >> 2) & 0x30);
 191         sprintf (buf, "0x%02x", x);
 192         sprintf (comment, "%d", x);
 193       }
 194       break;
 195
 196     case 's':
 197       sprintf (buf, "%d", insn & 7);
 198       break;
 199
 200     case 'S':
 201       sprintf (buf, "%d", (insn >> 4) & 7);
 202       break;
 203
 204     case 'P':
 205       {
 206         unsigned int x;
 207
 208         x = (insn & 0xf);
 209         x |= (insn >> 5) & 0x30;
 210         sprintf (buf, "0x%02x", x);
 211         sprintf (comment, "%d", x);
 212       }
 213       break;
 214
 215     case 'p':
 216       {
 217         unsigned int x;
 218
 219         x = (insn >> 3) & 0x1f;
 220         sprintf (buf, "0x%02x", x);
 221         sprintf (comment, "%d", x);
 222       }
 223       break;
 224
 225     case '?':
 226       *buf = '\0';
 227       break;
 228
 229     default:
 230       sprintf (buf, "??");
 231       fprintf (stderr, _("unknown constraint `%c'"), constraint);
 232       ok = 0;
 233     }
 234
 235     return ok;
 236 }
 237
 238 static unsigned short
 239 avrdis_opcode (bfd_vma addr, disassemble_info *info)
 240 {
 241   bfd_byte buffer[2];
 242   int status;
 243
 244   status = info->read_memory_func (addr, buffer, 2, info);
 245
 246   if (status == 0)
 247     return bfd_getl16 (buffer);
 248
 249   info->memory_error_func (status, addr, info);
 250   return -1;
 251 }
 252
 253
 254 int
 255 print_insn_avr (bfd_vma addr, disassemble_info *info)
 256 {
 257   unsigned int insn, insn2;
 258   const struct avr_opcodes_s *opcode;
 259   static unsigned int *maskptr;
 260   void *stream = info->stream;
 261   fprintf_ftype prin = info->fprintf_func;
 262   static unsigned int *avr_bin_masks;
 263   static int initialized;
 264   int cmd_len = 2;
 265   int ok = 0;
 266   char op1[20], op2[20], comment1[40], comment2[40];
 267   int sym_op1 = 0, sym_op2 = 0;
 268   bfd_vma sym_addr1, sym_addr2;
 269
 270   if (!initialized)
 271     {
 272       unsigned int nopcodes;
 273
 274       nopcodes = sizeof (avr_opcodes) / sizeof (struct avr_opcodes_s);
 275
 276       avr_bin_masks = xmalloc (nopcodes * sizeof (unsigned int));
 277
 278       for (opcode = avr_opcodes, maskptr = avr_bin_masks;
 279            opcode->name;
 280            opcode++, maskptr++)
 281         {
 282           char * s;
 283           unsigned int bin = 0;
 284           unsigned int mask = 0;
 285
 286           for (s = opcode->opcode; *s; ++s)
 287             {
 288               bin <<= 1;
 289               mask <<= 1;
 290               bin |= (*s == '1');
 291               mask |= (*s == '1' || *s == '0');
 292             }
 293           assert (s - opcode->opcode == 16);
 294           assert (opcode->bin_opcode == bin);
 295           *maskptr = mask;
 296         }
 297
 298       initialized = 1;
 299     }
 300
 301   insn = avrdis_opcode (addr, info);
 302
 303   for (opcode = avr_opcodes, maskptr = avr_bin_masks;
 304        opcode->name;
 305        opcode++, maskptr++)
 306     if ((insn & *maskptr) == opcode->bin_opcode)
 307       break;
 308
 309   /* Special case: disassemble `ldd r,b+0' as `ld r,b', and
 310      `std b+0,r' as `st b,r' (next entry in the table).  */
 311
 312   if (AVR_DISP0_P (insn))
 313     opcode++;
 314
 315   op1[0] = 0;
 316   op2[0] = 0;
 317   comment1[0] = 0;
 318   comment2[0] = 0;
 319
 320   if (opcode->name)
 321     {
 322       char *op = opcode->constraints;
 323
 324       insn2 = 0;
 325       ok = 1;
 326
 327       if (opcode->insn_size > 1)
 328         {
 329           insn2 = avrdis_opcode (addr + 2, info);
 330           cmd_len = 4;
 331         }
 332
 333       if (*op && *op != '?')
 334         {
 335           int regs = REGISTER_P (*op);
 336
 337           ok = avr_operand (insn, insn2, addr, *op, op1, comment1, 0, &sym_op1, &sym_addr1);
 338
 339           if (ok && *(++op) == ',')
 340             ok = avr_operand (insn, insn2, addr, *(++op), op2,
 341                               *comment1 ? comment2 : comment1, regs, &sym_op2, &sym_addr2);
 342         }
 343     }
 344
 345   if (!ok)
 346     {
 347       /* Unknown opcode, or invalid combination of operands.  */
 348       sprintf (op1, "0x%04x", insn);
 349       op2[0] = 0;
 350       sprintf (comment1, "????");
 351       comment2[0] = 0;
 352     }
 353
 354   (*prin) (stream, "%s", ok ? opcode->name : ".word");
 355
 356   if (*op1)
 357       (*prin) (stream, "\t%s", op1);
 358
 359   if (*op2)
 360     (*prin) (stream, ", %s", op2);
 361
 362   if (*comment1)
 363     (*prin) (stream, "\t; %s", comment1);
 364
 365   if (sym_op1)
 366     info->print_address_func (sym_addr1, info);
 367
 368   if (*comment2)
 369     (*prin) (stream, " %s", comment2);
 370
 371   if (sym_op2)
 372     info->print_address_func (sym_addr2, info);
 373
 374   return cmd_len;
 375 }