opcodes/avr-dis.c

   1 /* Disassemble AVR instructions.
   2    Copyright (C) 1999, 2000 Free Software Foundation, Inc.
   3
   4    Contributed by Denis Chertykov <denisc@overta.ru>
   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., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.  */
  19
  20 #include <assert.h>
  21 #include "sysdep.h"
  22 #include "dis-asm.h"
  23 #include "opintl.h"
  24
  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   unsigned int bin_mask;
  35 };
  36
  37 #define AVR_INSN(NAME, CONSTR, OPCODE, SIZE, ISA, BIN) \
  38 {#NAME, CONSTR, OPCODE, SIZE, ISA, BIN, 0},
  39
  40 struct avr_opcodes_s avr_opcodes[] =
  41 {
  42   #include "opcode/avr.h"
  43   {NULL, NULL, NULL, 0, 0, 0, 0}
  44 };
  45
  46
  47 static void avr_operand (unsigned int insn, unsigned int insn2,
  48                          unsigned int pc, int constraint, char *buf,
  49                          char *comment, int regs);
  50
  51 static void
  52 avr_operand (insn, insn2, pc, constraint, buf, comment, regs)
  53      unsigned int insn;
  54      unsigned int insn2;
  55      unsigned int pc;
  56      int constraint;
  57      char *buf;
  58      char *comment;
  59      int regs;
  60 {
  61   switch (constraint)
  62     {
  63       /* Any register operand.  */
  64     case 'r':
  65       if (regs)
  66         insn = (insn & 0xf) | ((insn & 0x0200) >> 5); /* source register */
  67       else
  68         insn = (insn & 0x01f0) >> 4; /* destination register */
  69
  70       sprintf (buf, "r%d", insn);
  71       break;
  72
  73     case 'd':
  74       if (regs)
  75         sprintf (buf, "r%d", 16 + (insn & 0xf));
  76       else
  77         sprintf (buf, "r%d", 16 + ((insn & 0xf0) >> 4));
  78       break;
  79
  80     case 'w':
  81       sprintf (buf, "r%d", 24 + ((insn & 0x30) >> 3));
  82       break;
  83
  84     case 'a':
  85       if (regs)
  86         sprintf (buf, "r%d", 16 + (insn & 7));
  87       else
  88         sprintf (buf, "r%d", 16 + ((insn >> 4) & 7));
  89       break;
  90
  91     case 'v':
  92       if (regs)
  93         sprintf (buf, "r%d", (insn & 0xf) * 2);
  94       else
  95         sprintf (buf, "r%d", ((insn & 0xf0) >> 3));
  96       break;
  97
  98     case 'e':
  99       if (insn & 0x2)
 100         *buf++ = '-';
 101       switch ((insn >> 2) & 0x3)
 102         {
 103         case 0: *buf++ = 'Z'; break;
 104         case 2: *buf++ = 'Y'; break;
 105         case 3: *buf++ = 'X'; break;
 106         default: buf += sprintf (buf, _ (" unknown register ")); break;
 107         }
 108       if (insn & 0x1)
 109         *buf++ = '+';
 110       *buf = '\0';
 111       break;
 112
 113     case 'z':
 114       *buf++ = 'Z';
 115       if (insn & 0x1)
 116         *buf++ = '+';
 117       *buf = '\0';
 118       break;
 119
 120     case 'b':
 121       {
 122         unsigned int x = insn;
 123
 124         x = (insn & 7);
 125         x |= (insn >> 7) & (3 << 3);
 126         x |= (insn >> 8) & (1 << 5);
 127
 128         if (insn & 0x8)
 129           *buf++ = 'Y';
 130         else
 131           *buf++ = 'Z';
 132         sprintf (buf, "+%d", x);
 133         sprintf (comment, "0x%02x", x);
 134       }
 135       break;
 136
 137     case 'h':
 138       sprintf (buf, "0x%x%x", (insn & 1) | ((insn & (0x1f << 4)) >> 3), insn2);
 139       break;
 140
 141     case 'L':
 142       {
 143         int rel_addr = (((insn & 0xfff) ^ 0x800) - 0x800) * 2;
 144         sprintf (buf, ".%+-8d", rel_addr);
 145         sprintf (comment, "0x%x", pc + 2 + rel_addr);
 146       }
 147       break;
 148
 149     case 'l':
 150       {
 151         int rel_addr = ((((insn >> 3) & 0x7f) ^ 0x40) - 0x40) * 2;
 152         sprintf (buf, ".%+-8d", rel_addr);
 153         sprintf (comment, "0x%x", pc + 2 + rel_addr);
 154       }
 155       break;
 156
 157     case 'i':
 158       sprintf (buf, "0x%04X", insn2);
 159       break;
 160
 161     case 'M':
 162       sprintf (buf, "0x%02X", ((insn & 0xf00) >> 4) | (insn & 0xf));
 163       sprintf (comment, "%d", ((insn & 0xf00) >> 4) | (insn & 0xf));
 164       break;
 165
 166     case 'n':
 167       sprintf (buf, _ ("Internal disassembler error"));
 168       break;
 169
 170     case 'K':
 171       sprintf (buf, "%d", (insn & 0xf) | ((insn >> 2) & 0x30));
 172       break;
 173
 174     case 's':
 175       sprintf (buf, "%d", insn & 7);
 176       break;
 177
 178     case 'S':
 179       sprintf (buf, "%d", (insn >> 4) & 7);
 180       break;
 181
 182     case 'P':
 183       {
 184         unsigned int x;
 185         x = (insn & 0xf);
 186         x |= (insn >> 5) & 0x30;
 187         sprintf (buf, "0x%02x", x);
 188         sprintf (comment, "%d", x);
 189       }
 190       break;
 191
 192     case 'p':
 193       {
 194         unsigned int x;
 195
 196         x = (insn >> 3) & 0x1f;
 197         sprintf (buf, "0x%02x", x);
 198         sprintf (comment, "%d", x);
 199       }
 200       break;
 201
 202     case '?':
 203       *buf = '\0';
 204       break;
 205
 206     default:
 207       sprintf (buf, _ ("unknown constraint `%c'"), constraint);
 208     }
 209 }
 210
 211 static unsigned short avrdis_opcode PARAMS ((bfd_vma, disassemble_info *));
 212
 213 static unsigned short
 214 avrdis_opcode (addr, info)
 215      bfd_vma addr;
 216      disassemble_info *info;
 217 {
 218   bfd_byte buffer[2];
 219   int status;
 220   status = info->read_memory_func(addr, buffer, 2, info);
 221   if (status != 0)
 222     {
 223       info->memory_error_func(status, addr, info);
 224       return -1;
 225     }
 226   return bfd_getl16 (buffer);
 227 }
 228
 229
 230 int
 231 print_insn_avr(addr, info)
 232      bfd_vma addr;
 233      disassemble_info *info;
 234 {
 235   unsigned int insn, insn2;
 236   struct avr_opcodes_s *opcode;
 237   void *stream = info->stream;
 238   fprintf_ftype prin = info->fprintf_func;
 239   static int initialized;
 240   int cmd_len = 2;
 241
 242   if (!initialized)
 243     {
 244       initialized = 1;
 245
 246       for (opcode = avr_opcodes; opcode->name; opcode++)
 247         {
 248           char * s;
 249           unsigned int bin = 0;
 250           unsigned int mask = 0;
 251
 252           for (s = opcode->opcode; *s; ++s)
 253             {
 254               bin <<= 1;
 255               mask <<= 1;
 256               bin |= (*s == '1');
 257               mask |= (*s == '1' || *s == '0');
 258             }
 259           assert (s - opcode->opcode == 16);
 260           assert (opcode->bin_opcode == bin);
 261           opcode->bin_mask = mask;
 262         }
 263     }
 264
 265   insn = avrdis_opcode (addr, info);
 266
 267   for (opcode = avr_opcodes; opcode->name; opcode++)
 268     {
 269       if ((insn & opcode->bin_mask) == opcode->bin_opcode)
 270         break;
 271     }
 272
 273   if (opcode->name)
 274     {
 275       char op1[20], op2[20], comment1[40], comment2[40];
 276       char *op = opcode->constraints;
 277
 278       op1[0] = 0;
 279       op2[0] = 0;
 280       comment1[0] = 0;
 281       comment2[0] = 0;
 282
 283       if (opcode->insn_size > 1)
 284         {
 285           insn2 = avrdis_opcode (addr + 2, info);
 286           cmd_len = 4;
 287         }
 288
 289       if (*op && *op != '?')
 290         {
 291           int regs = REGISTER_P (*op);
 292
 293           avr_operand (insn, insn2, addr, *op, op1, comment1, 0);
 294
 295           if (*(++op) == ',')
 296             avr_operand (insn, insn2, addr, *(++op), op2,
 297                          *comment1 ? comment2 : comment1, regs);
 298         }
 299
 300       (*prin) (stream, "    %-8s", opcode->name);
 301
 302       if (*op1)
 303         (*prin) (stream, "%s", op1);
 304
 305       if (*op2)
 306         (*prin) (stream, ", %s", op2);
 307
 308       if (*comment1)
 309         (*prin) (stream, "\t; %s", comment1);
 310
 311       if (*comment2)
 312         (*prin) (stream, " %s", comment2);
 313     }
 314   else
 315    (*prin) (stream, ".word 0x%04x\t; ????", insn);
 316
 317   return cmd_len;
 318 }