opcodes/avr-dis.c

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