sim/d10v/simops.c

   1 #include "config.h"
   2
   3 #include <signal.h>
   4 #include <errno.h>
   5 #include <sys/types.h>
   6 #include <sys/stat.h>
   7 #ifdef HAVE_UNISTD_H
   8 #include <unistd.h>
   9 #endif
  10
  11 #include "d10v_sim.h"
  12 #include "simops.h"
  13 #include "targ-vals.h"
  14
  15 extern char *strrchr ();
  16
  17 enum op_types {
  18   OP_VOID,
  19   OP_REG,
  20   OP_REG_OUTPUT,
  21   OP_DREG,
  22   OP_DREG_OUTPUT,
  23   OP_ACCUM,
  24   OP_ACCUM_OUTPUT,
  25   OP_ACCUM_REVERSE,
  26   OP_CR,
  27   OP_CR_OUTPUT,
  28   OP_CR_REVERSE,
  29   OP_FLAG,
  30   OP_FLAG_OUTPUT,
  31   OP_CONSTANT16,
  32   OP_CONSTANT8,
  33   OP_CONSTANT3,
  34   OP_CONSTANT4,
  35   OP_MEMREF,
  36   OP_MEMREF2,
  37   OP_MEMREF3,
  38   OP_POSTDEC,
  39   OP_POSTINC,
  40   OP_PREDEC,
  41   OP_R0,
  42   OP_R1,
  43   OP_R2,
  44 };
  45
  46
  47 enum {
  48   PSW_MASK = (PSW_SM_BIT
  49               | PSW_EA_BIT
  50               | PSW_DB_BIT
  51               | PSW_IE_BIT
  52               | PSW_RP_BIT
  53               | PSW_MD_BIT
  54               | PSW_FX_BIT
  55               | PSW_ST_BIT
  56               | PSW_F0_BIT
  57               | PSW_F1_BIT
  58               | PSW_C_BIT),
  59   /* The following bits in the PSW _can't_ be set by instructions such
  60      as mvtc. */
  61   PSW_HW_MASK = (PSW_MASK | PSW_DM_BIT)
  62 };
  63
  64 reg_t
  65 move_to_cr (int cr, reg_t mask, reg_t val, int psw_hw_p)
  66 {
  67   /* A MASK bit is set when the corresponding bit in the CR should
  68      be left alone */
  69   /* This assumes that (VAL & MASK) == 0 */
  70   switch (cr)
  71     {
  72     case PSW_CR:
  73       if (psw_hw_p)
  74         val &= PSW_HW_MASK;
  75       else
  76         val &= PSW_MASK;
  77       if ((mask & PSW_SM_BIT) == 0)
  78         {
  79           int new_psw_sm = (val & PSW_SM_BIT) != 0;
  80           /* save old SP */
  81           SET_HELD_SP (PSW_SM, GPR (SP_IDX));
  82           if (PSW_SM != new_psw_sm)
  83             /* restore new SP */
  84             SET_GPR (SP_IDX, HELD_SP (new_psw_sm));
  85         }
  86       if ((mask & (PSW_ST_BIT | PSW_FX_BIT)) == 0)
  87         {
  88           if (val & PSW_ST_BIT && !(val & PSW_FX_BIT))
  89             {
  90               (*d10v_callback->printf_filtered)
  91                 (d10v_callback,
  92                  "ERROR at PC 0x%x: ST can only be set when FX is set.\n",
  93                  PC<<2);
  94               State.exception = SIGILL;
  95             }
  96         }
  97       /* keep an up-to-date psw around for tracing */
  98       State.trace.psw = (State.trace.psw & mask) | val;
  99       break;
 100     case BPSW_CR:
 101     case DPSW_CR:
 102       /* Just like PSW, mask things like DM out. */
 103       if (psw_hw_p)
 104         val &= PSW_HW_MASK;
 105       else
 106         val &= PSW_MASK;
 107       break;
 108     case MOD_S_CR:
 109     case MOD_E_CR:
 110       val &= ~1;
 111       break;
 112     default:
 113       break;
 114     }
 115   /* only issue an update if the register is being changed */
 116   if ((State.cregs[cr] & ~mask) != val)
 117     SLOT_PEND_MASK (State.cregs[cr], mask, val);
 118   return val;
 119 }
 120
 121 #ifdef DEBUG
 122 static void trace_input_func PARAMS ((char *name,
 123                                       enum op_types in1,
 124                                       enum op_types in2,
 125                                       enum op_types in3));
 126
 127 #define trace_input(name, in1, in2, in3) do { if (d10v_debug) trace_input_func (name, in1, in2, in3); } while (0)
 128
 129 #ifndef SIZE_INSTRUCTION
 130 #define SIZE_INSTRUCTION 8
 131 #endif
 132
 133 #ifndef SIZE_OPERANDS
 134 #define SIZE_OPERANDS 18
 135 #endif
 136
 137 #ifndef SIZE_VALUES
 138 #define SIZE_VALUES 13
 139 #endif
 140
 141 #ifndef SIZE_LOCATION
 142 #define SIZE_LOCATION 20
 143 #endif
 144
 145 #ifndef SIZE_PC
 146 #define SIZE_PC 6
 147 #endif
 148
 149 #ifndef SIZE_LINE_NUMBER
 150 #define SIZE_LINE_NUMBER 4
 151 #endif
 152
 153 static void
 154 trace_input_func (name, in1, in2, in3)
 155      char *name;
 156      enum op_types in1;
 157      enum op_types in2;
 158      enum op_types in3;
 159 {
 160   char *comma;
 161   enum op_types in[3];
 162   int i;
 163   char buf[1024];
 164   char *p;
 165   long tmp;
 166   char *type;
 167   const char *filename;
 168   const char *functionname;
 169   unsigned int linenumber;
 170   bfd_vma byte_pc;
 171
 172   if ((d10v_debug & DEBUG_TRACE) == 0)
 173     return;
 174
 175   switch (State.ins_type)
 176     {
 177     default:
 178     case INS_UNKNOWN:           type = " ?"; break;
 179     case INS_LEFT:              type = " L"; break;
 180     case INS_RIGHT:             type = " R"; break;
 181     case INS_LEFT_PARALLEL:     type = "*L"; break;
 182     case INS_RIGHT_PARALLEL:    type = "*R"; break;
 183     case INS_LEFT_COND_TEST:    type = "?L"; break;
 184     case INS_RIGHT_COND_TEST:   type = "?R"; break;
 185     case INS_LEFT_COND_EXE:     type = "&L"; break;
 186     case INS_RIGHT_COND_EXE:    type = "&R"; break;
 187     case INS_LONG:              type = " B"; break;
 188     }
 189
 190   if ((d10v_debug & DEBUG_LINE_NUMBER) == 0)
 191     (*d10v_callback->printf_filtered) (d10v_callback,
 192                                        "0x%.*x %s: %-*s ",
 193                                        SIZE_PC, (unsigned)PC,
 194                                        type,
 195                                        SIZE_INSTRUCTION, name);
 196
 197   else
 198     {
 199       buf[0] = '\0';
 200       byte_pc = decode_pc ();
 201       if (text && byte_pc >= text_start && byte_pc < text_end)
 202         {
 203           filename = (const char *)0;
 204           functionname = (const char *)0;
 205           linenumber = 0;
 206           if (bfd_find_nearest_line (prog_bfd, text, (struct symbol_cache_entry **)0, byte_pc - text_start,
 207                                      &filename, &functionname, &linenumber))
 208             {
 209               p = buf;
 210               if (linenumber)
 211                 {
 212                   sprintf (p, "#%-*d ", SIZE_LINE_NUMBER, linenumber);
 213                   p += strlen (p);
 214                 }
 215               else
 216                 {
 217                   sprintf (p, "%-*s ", SIZE_LINE_NUMBER+1, "---");
 218                   p += SIZE_LINE_NUMBER+2;
 219                 }
 220
 221               if (functionname)
 222                 {
 223                   sprintf (p, "%s ", functionname);
 224                   p += strlen (p);
 225                 }
 226               else if (filename)
 227                 {
 228                   char *q = strrchr (filename, '/');
 229                   sprintf (p, "%s ", (q) ? q+1 : filename);
 230                   p += strlen (p);
 231                 }
 232
 233               if (*p == ' ')
 234                 *p = '\0';
 235             }
 236         }
 237
 238       (*d10v_callback->printf_filtered) (d10v_callback,
 239                                          "0x%.*x %s: %-*.*s %-*s ",
 240                                          SIZE_PC, (unsigned)PC,
 241                                          type,
 242                                          SIZE_LOCATION, SIZE_LOCATION, buf,
 243                                          SIZE_INSTRUCTION, name);
 244     }
 245
 246   in[0] = in1;
 247   in[1] = in2;
 248   in[2] = in3;
 249   comma = "";
 250   p = buf;
 251   for (i = 0; i < 3; i++)
 252     {
 253       switch (in[i])
 254         {
 255         case OP_VOID:
 256         case OP_R0:
 257         case OP_R1:
 258         case OP_R2:
 259           break;
 260
 261         case OP_REG:
 262         case OP_REG_OUTPUT:
 263         case OP_DREG:
 264         case OP_DREG_OUTPUT:
 265           sprintf (p, "%sr%d", comma, OP[i]);
 266           p += strlen (p);
 267           comma = ",";
 268           break;
 269
 270         case OP_CR:
 271         case OP_CR_OUTPUT:
 272         case OP_CR_REVERSE:
 273           sprintf (p, "%scr%d", comma, OP[i]);
 274           p += strlen (p);
 275           comma = ",";
 276           break;
 277
 278         case OP_ACCUM:
 279         case OP_ACCUM_OUTPUT:
 280         case OP_ACCUM_REVERSE:
 281           sprintf (p, "%sa%d", comma, OP[i]);
 282           p += strlen (p);
 283           comma = ",";
 284           break;
 285
 286         case OP_CONSTANT16:
 287           sprintf (p, "%s%d", comma, OP[i]);
 288           p += strlen (p);
 289           comma = ",";
 290           break;
 291
 292         case OP_CONSTANT8:
 293           sprintf (p, "%s%d", comma, SEXT8(OP[i]));
 294           p += strlen (p);
 295           comma = ",";
 296           break;
 297
 298         case OP_CONSTANT4:
 299           sprintf (p, "%s%d", comma, SEXT4(OP[i]));
 300           p += strlen (p);
 301           comma = ",";
 302           break;
 303
 304         case OP_CONSTANT3:
 305           sprintf (p, "%s%d", comma, SEXT3(OP[i]));
 306           p += strlen (p);
 307           comma = ",";
 308           break;
 309
 310         case OP_MEMREF:
 311           sprintf (p, "%s@r%d", comma, OP[i]);
 312           p += strlen (p);
 313           comma = ",";
 314           break;
 315
 316         case OP_MEMREF2:
 317           sprintf (p, "%s@(%d,r%d)", comma, (int16)OP[i], OP[i+1]);
 318           p += strlen (p);
 319           comma = ",";
 320           break;
 321
 322         case OP_MEMREF3:
 323           sprintf (p, "%s@%d", comma, OP[i]);
 324           p += strlen (p);
 325           comma = ",";
 326           break;
 327
 328         case OP_POSTINC:
 329           sprintf (p, "%s@r%d+", comma, OP[i]);
 330           p += strlen (p);
 331           comma = ",";
 332           break;
 333
 334         case OP_POSTDEC:
 335           sprintf (p, "%s@r%d-", comma, OP[i]);
 336           p += strlen (p);
 337           comma = ",";
 338           break;
 339
 340         case OP_PREDEC:
 341           sprintf (p, "%s@-r%d", comma, OP[i]);
 342           p += strlen (p);
 343           comma = ",";
 344           break;
 345
 346         case OP_FLAG:
 347         case OP_FLAG_OUTPUT:
 348           if (OP[i] == 0)
 349             sprintf (p, "%sf0", comma);
 350
 351           else if (OP[i] == 1)
 352             sprintf (p, "%sf1", comma);
 353
 354           else
 355             sprintf (p, "%sc", comma);
 356
 357           p += strlen (p);
 358           comma = ",";
 359           break;
 360         }
 361     }
 362
 363   if ((d10v_debug & DEBUG_VALUES) == 0)
 364     {
 365       *p++ = '\n';
 366       *p = '\0';
 367       (*d10v_callback->printf_filtered) (d10v_callback, "%s", buf);
 368     }
 369   else
 370     {
 371       *p = '\0';
 372       (*d10v_callback->printf_filtered) (d10v_callback, "%-*s", SIZE_OPERANDS, buf);
 373
 374       p = buf;
 375       for (i = 0; i < 3; i++)
 376         {
 377           buf[0] = '\0';
 378           switch (in[i])
 379             {
 380             case OP_VOID:
 381               (*d10v_callback->printf_filtered) (d10v_callback, "%*s", SIZE_VALUES, "");
 382               break;
 383
 384             case OP_REG_OUTPUT:
 385             case OP_DREG_OUTPUT:
 386             case OP_CR_OUTPUT:
 387             case OP_ACCUM_OUTPUT:
 388             case OP_FLAG_OUTPUT:
 389               (*d10v_callback->printf_filtered) (d10v_callback, "%*s", SIZE_VALUES, "---");
 390               break;
 391
 392             case OP_REG:
 393             case OP_MEMREF:
 394             case OP_POSTDEC:
 395             case OP_POSTINC:
 396             case OP_PREDEC:
 397               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 398                                                  (uint16) GPR (OP[i]));
 399               break;
 400
 401             case OP_MEMREF3:
 402               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "", (uint16) OP[i]);
 403               break;
 404
 405             case OP_DREG:
 406               tmp = (long)((((uint32) GPR (OP[i])) << 16) | ((uint32) GPR (OP[i] + 1)));
 407               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.8lx", SIZE_VALUES-10, "", tmp);
 408               break;
 409
 410             case OP_CR:
 411             case OP_CR_REVERSE:
 412               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 413                                                  (uint16) CREG (OP[i]));
 414               break;
 415
 416             case OP_ACCUM:
 417             case OP_ACCUM_REVERSE:
 418               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.2x%.8lx", SIZE_VALUES-12, "",
 419                                                  ((int)(ACC (OP[i]) >> 32) & 0xff),
 420                                                  ((unsigned long) ACC (OP[i])) & 0xffffffff);
 421               break;
 422
 423             case OP_CONSTANT16:
 424               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 425                                                  (uint16)OP[i]);
 426               break;
 427
 428             case OP_CONSTANT4:
 429               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 430                                                  (uint16)SEXT4(OP[i]));
 431               break;
 432
 433             case OP_CONSTANT8:
 434               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 435                                                  (uint16)SEXT8(OP[i]));
 436               break;
 437
 438             case OP_CONSTANT3:
 439               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 440                                                  (uint16)SEXT3(OP[i]));
 441               break;
 442
 443             case OP_FLAG:
 444               if (OP[i] == 0)
 445                 (*d10v_callback->printf_filtered) (d10v_callback, "%*sF0 = %d", SIZE_VALUES-6, "",
 446                                                    PSW_F0 != 0);
 447
 448               else if (OP[i] == 1)
 449                 (*d10v_callback->printf_filtered) (d10v_callback, "%*sF1 = %d", SIZE_VALUES-6, "",
 450                                                    PSW_F1 != 0);
 451
 452               else
 453                 (*d10v_callback->printf_filtered) (d10v_callback, "%*sC = %d", SIZE_VALUES-5, "",
 454                                                    PSW_C != 0);
 455
 456               break;
 457
 458             case OP_MEMREF2:
 459               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 460                                                  (uint16)OP[i]);
 461               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 462                                                  (uint16)GPR (OP[i + 1]));
 463               i++;
 464               break;
 465
 466             case OP_R0:
 467               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 468                                                  (uint16) GPR (0));
 469               break;
 470
 471             case OP_R1:
 472               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 473                                                  (uint16) GPR (1));
 474               break;
 475
 476             case OP_R2:
 477               (*d10v_callback->printf_filtered) (d10v_callback, "%*s0x%.4x", SIZE_VALUES-6, "",
 478                                                  (uint16) GPR (2));
 479               break;
 480
 481             }
 482         }
 483     }
 484
 485   (*d10v_callback->flush_stdout) (d10v_callback);
 486 }
 487
 488 static void
 489 do_trace_output_flush (void)
 490 {
 491   (*d10v_callback->flush_stdout) (d10v_callback);
 492 }
 493
 494 static void
 495 do_trace_output_finish (void)
 496 {
 497   (*d10v_callback->printf_filtered) (d10v_callback,
 498                                      " F0=%d F1=%d C=%d\n",
 499                                      (State.trace.psw & PSW_F0_BIT) != 0,
 500                                      (State.trace.psw & PSW_F1_BIT) != 0,
 501                                      (State.trace.psw & PSW_C_BIT) != 0);
 502   (*d10v_callback->flush_stdout) (d10v_callback);
 503 }
 504
 505 static void
 506 trace_output_40 (uint64 val)
 507 {
 508   if ((d10v_debug & (DEBUG_TRACE | DEBUG_VALUES)) == (DEBUG_TRACE | DEBUG_VALUES))
 509     {
 510       (*d10v_callback->printf_filtered) (d10v_callback,
 511                                          " :: %*s0x%.2x%.8lx",
 512                                          SIZE_VALUES - 12,
 513                                          "",
 514                                          ((int)(val >> 32) & 0xff),
 515                                          ((unsigned long) val) & 0xffffffff);
 516       do_trace_output_finish ();
 517     }
 518 }
 519
 520 static void
 521 trace_output_32 (uint32 val)
 522 {
 523   if ((d10v_debug & (DEBUG_TRACE | DEBUG_VALUES)) == (DEBUG_TRACE | DEBUG_VALUES))
 524     {
 525       (*d10v_callback->printf_filtered) (d10v_callback,
 526                                          " :: %*s0x%.8x",
 527                                          SIZE_VALUES - 10,
 528                                          "",
 529                                          (int) val);
 530       do_trace_output_finish ();
 531     }
 532 }
 533
 534 static void
 535 trace_output_16 (uint16 val)
 536 {
 537   if ((d10v_debug & (DEBUG_TRACE | DEBUG_VALUES)) == (DEBUG_TRACE | DEBUG_VALUES))
 538     {
 539       (*d10v_callback->printf_filtered) (d10v_callback,
 540                                          " :: %*s0x%.4x",
 541                                          SIZE_VALUES - 6,
 542                                          "",
 543                                          (int) val);
 544       do_trace_output_finish ();
 545     }
 546 }
 547
 548 static void
 549 trace_output_void ()
 550 {
 551   if ((d10v_debug & (DEBUG_TRACE | DEBUG_VALUES)) == (DEBUG_TRACE | DEBUG_VALUES))
 552     {
 553       (*d10v_callback->printf_filtered) (d10v_callback, "\n");
 554       do_trace_output_flush ();
 555     }
 556 }
 557
 558 static void
 559 trace_output_flag ()
 560 {
 561   if ((d10v_debug & (DEBUG_TRACE | DEBUG_VALUES)) == (DEBUG_TRACE | DEBUG_VALUES))
 562     {
 563       (*d10v_callback->printf_filtered) (d10v_callback,
 564                                          " :: %*s",
 565                                          SIZE_VALUES,
 566                                          "");
 567       do_trace_output_finish ();
 568     }
 569 }
 570
 571
 572
 573
 574 #else
 575 #define trace_input(NAME, IN1, IN2, IN3)
 576 #define trace_output(RESULT)
 577 #endif
 578
 579 /* abs */
 580 void
 581 OP_4607 ()
 582 {
 583   int16 tmp;
 584   trace_input ("abs", OP_REG, OP_VOID, OP_VOID);
 585   SET_PSW_F1 (PSW_F0);
 586   tmp = GPR(OP[0]);
 587   if (tmp < 0)
 588     {
 589       tmp = - tmp;
 590       SET_PSW_F0 (1);
 591     }
 592   else
 593     SET_PSW_F0 (0);
 594   SET_GPR (OP[0], tmp);
 595   trace_output_16 (tmp);
 596 }
 597
 598 /* abs */
 599 void
 600 OP_5607 ()
 601 {
 602   int64 tmp;
 603   trace_input ("abs", OP_ACCUM, OP_VOID, OP_VOID);
 604   SET_PSW_F1 (PSW_F0);
 605
 606   tmp = SEXT40 (ACC (OP[0]));
 607   if (tmp < 0 )
 608     {
 609       tmp = - tmp;
 610       if (PSW_ST)
 611         {
 612           if (tmp > SEXT40(MAX32))
 613             tmp = (MAX32);
 614           else if (tmp < SEXT40(MIN32))
 615             tmp = (MIN32);
 616           else
 617             tmp = (tmp & MASK40);
 618         }
 619       else
 620         tmp = (tmp & MASK40);
 621       SET_PSW_F0 (1);
 622     }
 623   else
 624     {
 625       tmp = (tmp & MASK40);
 626       SET_PSW_F0 (0);
 627     }
 628   SET_ACC (OP[0], tmp);
 629   trace_output_40 (tmp);
 630 }
 631
 632 /* add */
 633 void
 634 OP_200 ()
 635 {
 636   uint16 a = GPR (OP[0]);
 637   uint16 b = GPR (OP[1]);
 638   uint16 tmp = (a + b);
 639   trace_input ("add", OP_REG, OP_REG, OP_VOID);
 640   SET_PSW_C (a > tmp);
 641   SET_GPR (OP[0], tmp);
 642   trace_output_16 (tmp);
 643 }
 644
 645 /* add */
 646 void
 647 OP_1201 ()
 648 {
 649   int64 tmp;
 650   tmp = SEXT40(ACC (OP[0])) + (SEXT16 (GPR (OP[1])) << 16 | GPR (OP[1] + 1));
 651
 652   trace_input ("add", OP_ACCUM, OP_REG, OP_VOID);
 653   if (PSW_ST)
 654     {
 655       if (tmp > SEXT40(MAX32))
 656         tmp = (MAX32);
 657       else if (tmp < SEXT40(MIN32))
 658         tmp = (MIN32);
 659       else
 660         tmp = (tmp & MASK40);
 661     }
 662   else
 663     tmp = (tmp & MASK40);
 664   SET_ACC (OP[0], tmp);
 665   trace_output_40 (tmp);
 666 }
 667
 668 /* add */
 669 void
 670 OP_1203 ()
 671 {
 672   int64 tmp;
 673   tmp = SEXT40(ACC (OP[0])) + SEXT40(ACC (OP[1]));
 674
 675   trace_input ("add", OP_ACCUM, OP_ACCUM, OP_VOID);
 676   if (PSW_ST)
 677     {
 678       if (tmp > SEXT40(MAX32))
 679         tmp = (MAX32);
 680       else if (tmp < SEXT40(MIN32))
 681         tmp = (MIN32);
 682       else
 683         tmp = (tmp & MASK40);
 684     }
 685   else
 686     tmp = (tmp & MASK40);
 687   SET_ACC (OP[0], tmp);
 688   trace_output_40 (tmp);
 689 }
 690
 691 /* add2w */
 692 void
 693 OP_1200 ()
 694 {
 695   uint32 tmp;
 696   uint32 a = (GPR (OP[0])) << 16 | GPR (OP[0] + 1);
 697   uint32 b = (GPR (OP[1])) << 16 | GPR (OP[1] + 1);
 698   trace_input ("add2w", OP_DREG, OP_DREG, OP_VOID);
 699   tmp = a + b;
 700   SET_PSW_C (tmp < a);
 701   SET_GPR (OP[0] + 0, (tmp >> 16));
 702   SET_GPR (OP[0] + 1, (tmp & 0xFFFF));
 703   trace_output_32 (tmp);
 704 }
 705
 706 /* add3 */
 707 void
 708 OP_1000000 ()
 709 {
 710   uint16 a = GPR (OP[1]);
 711   uint16 b = OP[2];
 712   uint16 tmp = (a + b);
 713   trace_input ("add3", OP_REG_OUTPUT, OP_REG, OP_CONSTANT16);
 714   SET_PSW_C (tmp < a);
 715   SET_GPR (OP[0], tmp);
 716   trace_output_16 (tmp);
 717 }
 718
 719 /* addac3 */
 720 void
 721 OP_17000200 ()
 722 {
 723   int64 tmp;
 724   tmp = SEXT40(ACC (OP[2])) + SEXT40 ((GPR (OP[1]) << 16) | GPR (OP[1] + 1));
 725
 726   trace_input ("addac3", OP_DREG_OUTPUT, OP_DREG, OP_ACCUM);
 727   SET_GPR (OP[0] + 0, ((tmp >> 16) & 0xffff));
 728   SET_GPR (OP[0] + 1, (tmp & 0xffff));
 729   trace_output_32 (tmp);
 730 }
 731
 732 /* addac3 */
 733 void
 734 OP_17000202 ()
 735 {
 736   int64 tmp;
 737   tmp = SEXT40(ACC (OP[1])) + SEXT40(ACC (OP[2]));
 738
 739   trace_input ("addac3", OP_DREG_OUTPUT, OP_ACCUM, OP_ACCUM);
 740   SET_GPR (OP[0] + 0, (tmp >> 16) & 0xffff);
 741   SET_GPR (OP[0] + 1, tmp & 0xffff);
 742   trace_output_32 (tmp);
 743 }
 744
 745 /* addac3s */
 746 void
 747 OP_17001200 ()
 748 {
 749   int64 tmp;
 750   SET_PSW_F1 (PSW_F0);
 751
 752   trace_input ("addac3s", OP_DREG_OUTPUT, OP_DREG, OP_ACCUM);
 753   tmp = SEXT40 (ACC (OP[2])) + SEXT40 ((GPR (OP[1]) << 16) | GPR (OP[1] + 1));
 754   if (tmp > SEXT40(MAX32))
 755     {
 756       tmp = (MAX32);
 757       SET_PSW_F0 (1);
 758     }
 759   else if (tmp < SEXT40(MIN32))
 760     {
 761       tmp = (MIN32);
 762       SET_PSW_F0 (1);
 763     }
 764   else
 765     {
 766       SET_PSW_F0 (0);
 767     }
 768   SET_GPR (OP[0] + 0, (tmp >> 16) & 0xffff);
 769   SET_GPR (OP[0] + 1, (tmp & 0xffff));
 770   trace_output_32 (tmp);
 771 }
 772
 773 /* addac3s */
 774 void
 775 OP_17001202 ()
 776 {
 777   int64 tmp;
 778   SET_PSW_F1 (PSW_F0);
 779
 780   trace_input ("addac3s", OP_DREG_OUTPUT, OP_ACCUM, OP_ACCUM);
 781   tmp = SEXT40(ACC (OP[1])) + SEXT40(ACC (OP[2]));
 782   if (tmp > SEXT40(MAX32))
 783     {
 784       tmp = (MAX32);
 785       SET_PSW_F0 (1);
 786     }
 787   else if (tmp < SEXT40(MIN32))
 788     {
 789       tmp = (MIN32);
 790       SET_PSW_F0 (1);
 791     }
 792   else
 793     {
 794       SET_PSW_F0 (0);
 795     }
 796   SET_GPR (OP[0] + 0, (tmp >> 16) & 0xffff);
 797   SET_GPR (OP[0] + 1, (tmp & 0xffff));
 798   trace_output_32 (tmp);
 799 }
 800
 801 /* addi */
 802 void
 803 OP_201 ()
 804 {
 805   uint16 a = GPR (OP[0]);
 806   uint16 b;
 807   uint16 tmp;
 808   if (OP[1] == 0)
 809     OP[1] = 16;
 810   b = OP[1];
 811   tmp = (a + b);
 812   trace_input ("addi", OP_REG, OP_CONSTANT16, OP_VOID);
 813   SET_PSW_C (tmp < a);
 814   SET_GPR (OP[0], tmp);
 815   trace_output_16 (tmp);
 816 }
 817
 818 /* and */
 819 void
 820 OP_C00 ()
 821 {
 822   uint16 tmp = GPR (OP[0]) & GPR (OP[1]);
 823   trace_input ("and", OP_REG, OP_REG, OP_VOID);
 824   SET_GPR (OP[0], tmp);
 825   trace_output_16 (tmp);
 826 }
 827
 828 /* and3 */
 829 void
 830 OP_6000000 ()
 831 {
 832   uint16 tmp = GPR (OP[1]) & OP[2];
 833   trace_input ("and3", OP_REG_OUTPUT, OP_REG, OP_CONSTANT16);
 834   SET_GPR (OP[0], tmp);
 835   trace_output_16 (tmp);
 836 }
 837
 838 /* bclri */
 839 void
 840 OP_C01 ()
 841 {
 842   int16 tmp;
 843   trace_input ("bclri", OP_REG, OP_CONSTANT16, OP_VOID);
 844   tmp = (GPR (OP[0]) &~(0x8000 >> OP[1]));
 845   SET_GPR (OP[0], tmp);
 846   trace_output_16 (tmp);
 847 }
 848
 849 /* bl.s */
 850 void
 851 OP_4900 ()
 852 {
 853   trace_input ("bl.s", OP_CONSTANT8, OP_R0, OP_R1);
 854   SET_GPR (13, PC + 1);
 855   JMP( PC + SEXT8 (OP[0]));
 856   trace_output_void ();
 857 }
 858
 859 /* bl.l */
 860 void
 861 OP_24800000 ()
 862 {
 863   trace_input ("bl.l", OP_CONSTANT16, OP_R0, OP_R1);
 864   SET_GPR (13, (PC + 1));
 865   JMP (PC + OP[0]);
 866   trace_output_void ();
 867 }
 868
 869 /* bnoti */
 870 void
 871 OP_A01 ()
 872 {
 873   int16 tmp;
 874   trace_input ("bnoti", OP_REG, OP_CONSTANT16, OP_VOID);
 875   tmp = (GPR (OP[0]) ^ (0x8000 >> OP[1]));
 876   SET_GPR (OP[0], tmp);
 877   trace_output_16 (tmp);
 878 }
 879
 880 /* bra.s */
 881 void
 882 OP_4800 ()
 883 {
 884   trace_input ("bra.s", OP_CONSTANT8, OP_VOID, OP_VOID);
 885   JMP (PC + SEXT8 (OP[0]));
 886   trace_output_void ();
 887 }
 888
 889 /* bra.l */
 890 void
 891 OP_24000000 ()
 892 {
 893   trace_input ("bra.l", OP_CONSTANT16, OP_VOID, OP_VOID);
 894   JMP (PC + OP[0]);
 895   trace_output_void ();
 896 }
 897
 898 /* brf0f.s */
 899 void
 900 OP_4A00 ()
 901 {
 902   trace_input ("brf0f.s", OP_CONSTANT8, OP_VOID, OP_VOID);
 903   if (!PSW_F0)
 904     JMP (PC + SEXT8 (OP[0]));
 905   trace_output_flag ();
 906 }
 907
 908 /* brf0f.l */
 909 void
 910 OP_25000000 ()
 911 {
 912   trace_input ("brf0f.l", OP_CONSTANT16, OP_VOID, OP_VOID);
 913   if (!PSW_F0)
 914     JMP (PC + OP[0]);
 915   trace_output_flag ();
 916 }
 917
 918 /* brf0t.s */
 919 void
 920 OP_4B00 ()
 921 {
 922   trace_input ("brf0t.s", OP_CONSTANT8, OP_VOID, OP_VOID);
 923   if (PSW_F0)
 924     JMP (PC + SEXT8 (OP[0]));
 925   trace_output_flag ();
 926 }
 927
 928 /* brf0t.l */
 929 void
 930 OP_25800000 ()
 931 {
 932   trace_input ("brf0t.l", OP_CONSTANT16, OP_VOID, OP_VOID);
 933   if (PSW_F0)
 934     JMP (PC + OP[0]);
 935   trace_output_flag ();
 936 }
 937
 938 /* bseti */
 939 void
 940 OP_801 ()
 941 {
 942   int16 tmp;
 943   trace_input ("bseti", OP_REG, OP_CONSTANT16, OP_VOID);
 944   tmp = (GPR (OP[0]) | (0x8000 >> OP[1]));
 945   SET_GPR (OP[0], tmp);
 946   trace_output_16 (tmp);
 947 }
 948
 949 /* btsti */
 950 void
 951 OP_E01 ()
 952 {
 953   trace_input ("btsti", OP_REG, OP_CONSTANT16, OP_VOID);
 954   SET_PSW_F1 (PSW_F0);
 955   SET_PSW_F0 ((GPR (OP[0]) & (0x8000 >> OP[1])) ? 1 : 0);
 956   trace_output_flag ();
 957 }
 958
 959 /* clrac */
 960 void
 961 OP_5601 ()
 962 {
 963   trace_input ("clrac", OP_ACCUM_OUTPUT, OP_VOID, OP_VOID);
 964   SET_ACC (OP[0], 0);
 965   trace_output_40 (0);
 966 }
 967
 968 /* cmp */
 969 void
 970 OP_600 ()
 971 {
 972   trace_input ("cmp", OP_REG, OP_REG, OP_VOID);
 973   SET_PSW_F1 (PSW_F0);
 974   SET_PSW_F0 (((int16)(GPR (OP[0])) < (int16)(GPR (OP[1]))) ? 1 : 0);
 975   trace_output_flag ();
 976 }
 977
 978 /* cmp */
 979 void
 980 OP_1603 ()
 981 {
 982   trace_input ("cmp", OP_ACCUM, OP_ACCUM, OP_VOID);
 983   SET_PSW_F1 (PSW_F0);
 984   SET_PSW_F0 ((SEXT40(ACC (OP[0])) < SEXT40(ACC (OP[1]))) ? 1 : 0);
 985   trace_output_flag ();
 986 }
 987
 988 /* cmpeq */
 989 void
 990 OP_400 ()
 991 {
 992   trace_input ("cmpeq", OP_REG, OP_REG, OP_VOID);
 993   SET_PSW_F1 (PSW_F0);
 994   SET_PSW_F0 ((GPR (OP[0]) == GPR (OP[1])) ? 1 : 0);
 995   trace_output_flag ();
 996 }
 997
 998 /* cmpeq */
 999 void
1000 OP_1403 ()
1001 {
1002   trace_input ("cmpeq", OP_ACCUM, OP_ACCUM, OP_VOID);
1003   SET_PSW_F1 (PSW_F0);
1004   SET_PSW_F0 (((ACC (OP[0]) & MASK40) == (ACC (OP[1]) & MASK40)) ? 1 : 0);
1005   trace_output_flag ();
1006 }
1007
1008 /* cmpeqi.s */
1009 void
1010 OP_401 ()
1011 {
1012   trace_input ("cmpeqi.s", OP_REG, OP_CONSTANT4, OP_VOID);
1013   SET_PSW_F1 (PSW_F0);
1014   SET_PSW_F0 ((GPR (OP[0]) == (reg_t) SEXT4 (OP[1])) ? 1 : 0);
1015   trace_output_flag ();
1016 }
1017
1018 /* cmpeqi.l */
1019 void
1020 OP_2000000 ()
1021 {
1022   trace_input ("cmpeqi.l", OP_REG, OP_CONSTANT16, OP_VOID);
1023   SET_PSW_F1 (PSW_F0);
1024   SET_PSW_F0 ((GPR (OP[0]) == (reg_t)OP[1]) ? 1 : 0);
1025   trace_output_flag ();
1026 }
1027
1028 /* cmpi.s */
1029 void
1030 OP_601 ()
1031 {
1032   trace_input ("cmpi.s", OP_REG, OP_CONSTANT4, OP_VOID);
1033   SET_PSW_F1 (PSW_F0);
1034   SET_PSW_F0 (((int16)(GPR (OP[0])) < (int16)SEXT4(OP[1])) ? 1 : 0);
1035   trace_output_flag ();
1036 }
1037
1038 /* cmpi.l */
1039 void
1040 OP_3000000 ()
1041 {
1042   trace_input ("cmpi.l", OP_REG, OP_CONSTANT16, OP_VOID);
1043   SET_PSW_F1 (PSW_F0);
1044   SET_PSW_F0 (((int16)(GPR (OP[0])) < (int16)(OP[1])) ? 1 : 0);
1045   trace_output_flag ();
1046 }
1047
1048 /* cmpu */
1049 void
1050 OP_4600 ()
1051 {
1052   trace_input ("cmpu", OP_REG, OP_REG, OP_VOID);
1053   SET_PSW_F1 (PSW_F0);
1054   SET_PSW_F0 ((GPR (OP[0]) < GPR (OP[1])) ? 1 : 0);
1055   trace_output_flag ();
1056 }
1057
1058 /* cmpui */
1059 void
1060 OP_23000000 ()
1061 {
1062   trace_input ("cmpui", OP_REG, OP_CONSTANT16, OP_VOID);
1063   SET_PSW_F1 (PSW_F0);
1064   SET_PSW_F0 ((GPR (OP[0]) < (reg_t)OP[1]) ? 1 : 0);
1065   trace_output_flag ();
1066 }
1067
1068 /* cpfg */
1069 void
1070 OP_4E09 ()
1071 {
1072   uint8 val;
1073
1074   trace_input ("cpfg", OP_FLAG_OUTPUT, OP_FLAG, OP_VOID);
1075
1076   if (OP[1] == 0)
1077     val = PSW_F0;
1078   else if (OP[1] == 1)
1079     val = PSW_F1;
1080   else
1081     val = PSW_C;
1082   if (OP[0] == 0)
1083     SET_PSW_F0 (val);
1084   else
1085     SET_PSW_F1 (val);
1086
1087   trace_output_flag ();
1088 }
1089
1090 /* cpfg */
1091 void
1092 OP_4E0F ()
1093 {
1094   uint8 val;
1095
1096   trace_input ("cpfg", OP_FLAG_OUTPUT, OP_FLAG, OP_VOID);
1097
1098   if (OP[1] == 0)
1099     val = PSW_F0;
1100   else if (OP[1] == 1)
1101     val = PSW_F1;
1102   else
1103     val = PSW_C;
1104   if (OP[0] == 0)
1105     SET_PSW_F0 (val);
1106   else
1107     SET_PSW_F1 (val);
1108
1109   trace_output_flag ();
1110 }
1111
1112 /* dbt */
1113 void
1114 OP_5F20 ()
1115 {
1116   /* d10v_callback->printf_filtered(d10v_callback, "***** DBT *****  PC=%x\n",PC); */
1117
1118   /* GDB uses the instruction pair ``dbt || nop'' as a break-point.
1119      The conditional below is for either of the instruction pairs
1120      ``dbt -> XXX'' or ``dbt <- XXX'' and treats them as as cases
1121      where the dbt instruction should be interpreted.
1122
1123      The module `sim-break' provides a more effective mechanism for
1124      detecting GDB planted breakpoints.  The code below may,
1125      eventually, be changed to use that mechanism. */
1126
1127   if (State.ins_type == INS_LEFT
1128       || State.ins_type == INS_RIGHT)
1129     {
1130       trace_input ("dbt", OP_VOID, OP_VOID, OP_VOID);
1131       SET_DPC (PC + 1);
1132       SET_DPSW (PSW);
1133       SET_HW_PSW (PSW_DM_BIT | (PSW & (PSW_F0_BIT | PSW_F1_BIT | PSW_C_BIT)));
1134       JMP (DBT_VECTOR_START);
1135       trace_output_void ();
1136     }
1137   else
1138     {
1139       State.exception = SIGTRAP;
1140     }
1141 }
1142
1143 /* divs */
1144 void
1145 OP_14002800 ()
1146 {
1147   uint16 foo, tmp, tmpf;
1148   uint16 hi;
1149   uint16 lo;
1150
1151   trace_input ("divs", OP_DREG, OP_REG, OP_VOID);
1152   foo = (GPR (OP[0]) << 1) | (GPR (OP[0] + 1) >> 15);
1153   tmp = (int16)foo - (int16)(GPR (OP[1]));
1154   tmpf = (foo >= GPR (OP[1])) ? 1 : 0;
1155   hi = ((tmpf == 1) ? tmp : foo);
1156   lo = ((GPR (OP[0] + 1) << 1) | tmpf);
1157   SET_GPR (OP[0] + 0, hi);
1158   SET_GPR (OP[0] + 1, lo);
1159   trace_output_32 (((uint32) hi << 16) | lo);
1160 }
1161
1162 /* exef0f */
1163 void
1164 OP_4E04 ()
1165 {
1166   trace_input ("exef0f", OP_VOID, OP_VOID, OP_VOID);
1167   State.exe = (PSW_F0 == 0);
1168   trace_output_flag ();
1169 }
1170
1171 /* exef0t */
1172 void
1173 OP_4E24 ()
1174 {
1175   trace_input ("exef0t", OP_VOID, OP_VOID, OP_VOID);
1176   State.exe = (PSW_F0 != 0);
1177   trace_output_flag ();
1178 }
1179
1180 /* exef1f */
1181 void
1182 OP_4E40 ()
1183 {
1184   trace_input ("exef1f", OP_VOID, OP_VOID, OP_VOID);
1185   State.exe = (PSW_F1 == 0);
1186   trace_output_flag ();
1187 }
1188
1189 /* exef1t */
1190 void
1191 OP_4E42 ()
1192 {
1193   trace_input ("exef1t", OP_VOID, OP_VOID, OP_VOID);
1194   State.exe = (PSW_F1 != 0);
1195   trace_output_flag ();
1196 }
1197
1198 /* exefaf */
1199 void
1200 OP_4E00 ()
1201 {
1202   trace_input ("exefaf", OP_VOID, OP_VOID, OP_VOID);
1203   State.exe = (PSW_F0 == 0) & (PSW_F1 == 0);
1204   trace_output_flag ();
1205 }
1206
1207 /* exefat */
1208 void
1209 OP_4E02 ()
1210 {
1211   trace_input ("exefat", OP_VOID, OP_VOID, OP_VOID);
1212   State.exe = (PSW_F0 == 0) & (PSW_F1 != 0);
1213   trace_output_flag ();
1214 }
1215
1216 /* exetaf */
1217 void
1218 OP_4E20 ()
1219 {
1220   trace_input ("exetaf", OP_VOID, OP_VOID, OP_VOID);
1221   State.exe = (PSW_F0 != 0) & (PSW_F1 == 0);
1222   trace_output_flag ();
1223 }
1224
1225 /* exetat */
1226 void
1227 OP_4E22 ()
1228 {
1229   trace_input ("exetat", OP_VOID, OP_VOID, OP_VOID);
1230   State.exe = (PSW_F0 != 0) & (PSW_F1 != 0);
1231   trace_output_flag ();
1232 }
1233
1234 /* exp */
1235 void
1236 OP_15002A00 ()
1237 {
1238   uint32 tmp, foo;
1239   int i;
1240
1241   trace_input ("exp", OP_REG_OUTPUT, OP_DREG, OP_VOID);
1242   if (((int16)GPR (OP[1])) >= 0)
1243     tmp = (GPR (OP[1]) << 16) | GPR (OP[1] + 1);
1244   else
1245     tmp = ~((GPR (OP[1]) << 16) | GPR (OP[1] + 1));
1246
1247   foo = 0x40000000;
1248   for (i=1;i<17;i++)
1249     {
1250       if (tmp & foo)
1251         {
1252           SET_GPR (OP[0], (i - 1));
1253           trace_output_16 (i - 1);
1254           return;
1255         }
1256       foo >>= 1;
1257     }
1258   SET_GPR (OP[0], 16);
1259   trace_output_16 (16);
1260 }
1261
1262 /* exp */
1263 void
1264 OP_15002A02 ()
1265 {
1266   int64 tmp, foo;
1267   int i;
1268
1269   trace_input ("exp", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
1270   tmp = SEXT40(ACC (OP[1]));
1271   if (tmp < 0)
1272     tmp = ~tmp & MASK40;
1273
1274   foo = 0x4000000000LL;
1275   for (i=1;i<25;i++)
1276     {
1277       if (tmp & foo)
1278         {
1279           SET_GPR (OP[0], i - 9);
1280           trace_output_16 (i - 9);
1281           return;
1282         }
1283       foo >>= 1;
1284     }
1285   SET_GPR (OP[0], 16);
1286   trace_output_16 (16);
1287 }
1288
1289 /* jl */
1290 void
1291 OP_4D00 ()
1292 {
1293   trace_input ("jl", OP_REG, OP_R0, OP_R1);
1294   SET_GPR (13, PC + 1);
1295   JMP (GPR (OP[0]));
1296   trace_output_void ();
1297 }
1298
1299 /* jmp */
1300 void
1301 OP_4C00 ()
1302 {
1303   trace_input ("jmp", OP_REG,
1304                (OP[0] == 13) ? OP_R0 : OP_VOID,
1305                (OP[0] == 13) ? OP_R1 : OP_VOID);
1306
1307   JMP (GPR (OP[0]));
1308   trace_output_void ();
1309 }
1310
1311 /* ld */
1312 void
1313 OP_30000000 ()
1314 {
1315   uint16 tmp;
1316   trace_input ("ld", OP_REG_OUTPUT, OP_MEMREF2, OP_VOID);
1317   tmp = RW (OP[1] + GPR (OP[2]));
1318   SET_GPR (OP[0], tmp);
1319   trace_output_16 (tmp);
1320 }
1321
1322 /* ld */
1323 void
1324 OP_6401 ()
1325 {
1326   uint16 tmp;
1327   trace_input ("ld", OP_REG_OUTPUT, OP_POSTDEC, OP_VOID);
1328   tmp = RW (GPR (OP[1]));
1329   SET_GPR (OP[0], tmp);
1330   if (OP[0] != OP[1])
1331     INC_ADDR (OP[1], -2);
1332   trace_output_16 (tmp);
1333 }
1334
1335 /* ld */
1336 void
1337 OP_6001 ()
1338 {
1339   uint16 tmp;
1340   trace_input ("ld", OP_REG_OUTPUT, OP_POSTINC, OP_VOID);
1341   tmp = RW (GPR (OP[1]));
1342   SET_GPR (OP[0], tmp);
1343   if (OP[0] != OP[1])
1344     INC_ADDR (OP[1], 2);
1345   trace_output_16 (tmp);
1346 }
1347
1348 /* ld */
1349 void
1350 OP_6000 ()
1351 {
1352   uint16 tmp;
1353   trace_input ("ld", OP_REG_OUTPUT, OP_MEMREF, OP_VOID);
1354   tmp = RW (GPR (OP[1]));
1355   SET_GPR (OP[0], tmp);
1356   trace_output_16 (tmp);
1357 }
1358
1359 /* ld */
1360 void
1361 OP_32010000 ()
1362 {
1363   uint16 tmp;
1364
1365   trace_input ("ld", OP_REG_OUTPUT, OP_MEMREF3, OP_VOID);
1366   tmp = RW (OP[1]);
1367   SET_GPR (OP[0], tmp);
1368   trace_output_16 (tmp);
1369 }
1370
1371 /* ld2w */
1372 void
1373 OP_31000000 ()
1374 {
1375   int32 tmp;
1376   uint16 addr = GPR (OP[2]);
1377   trace_input ("ld2w", OP_REG_OUTPUT, OP_MEMREF2, OP_VOID);
1378   tmp = RLW (OP[1] + addr);
1379   SET_GPR32 (OP[0], tmp);
1380   trace_output_32 (tmp);
1381 }
1382
1383 /* ld2w */
1384 void
1385 OP_6601 ()
1386 {
1387   uint16 addr = GPR (OP[1]);
1388   int32 tmp;
1389   trace_input ("ld2w", OP_REG_OUTPUT, OP_POSTDEC, OP_VOID);
1390   tmp = RLW (addr);
1391   SET_GPR32 (OP[0], tmp);
1392   if (OP[0] != OP[1] && ((OP[0] + 1) != OP[1]))
1393     INC_ADDR (OP[1], -4);
1394   trace_output_32 (tmp);
1395 }
1396
1397 /* ld2w */
1398 void
1399 OP_6201 ()
1400 {
1401   int32 tmp;
1402   uint16 addr = GPR (OP[1]);
1403   trace_input ("ld2w", OP_REG_OUTPUT, OP_POSTINC, OP_VOID);
1404   tmp = RLW (addr);
1405   SET_GPR32 (OP[0], tmp);
1406   if (OP[0] != OP[1] && ((OP[0] + 1) != OP[1]))
1407     INC_ADDR (OP[1], 4);
1408   trace_output_32 (tmp);
1409 }
1410
1411 /* ld2w */
1412 void
1413 OP_6200 ()
1414 {
1415   uint16 addr = GPR (OP[1]);
1416   int32 tmp;
1417   trace_input ("ld2w", OP_REG_OUTPUT, OP_MEMREF, OP_VOID);
1418   tmp = RLW (addr + 0);
1419   SET_GPR32 (OP[0], tmp);
1420   trace_output_32 (tmp);
1421 }
1422
1423 /* ld2w */
1424 void
1425 OP_33010000 ()
1426 {
1427   int32 tmp;
1428
1429   trace_input ("ld2w", OP_REG_OUTPUT, OP_MEMREF3, OP_VOID);
1430   tmp = RLW (OP[1]);
1431   SET_GPR32 (OP[0], tmp);
1432   trace_output_32 (tmp);
1433 }
1434
1435 /* ldb */
1436 void
1437 OP_38000000 ()
1438 {
1439   int16 tmp;
1440   trace_input ("ldb", OP_REG_OUTPUT, OP_MEMREF2, OP_VOID);
1441   tmp = SEXT8 (RB (OP[1] + GPR (OP[2])));
1442   SET_GPR (OP[0], tmp);
1443   trace_output_16 (tmp);
1444 }
1445
1446 /* ldb */
1447 void
1448 OP_7000 ()
1449 {
1450   int16 tmp;
1451   trace_input ("ldb", OP_REG_OUTPUT, OP_MEMREF, OP_VOID);
1452   tmp = SEXT8 (RB (GPR (OP[1])));
1453   SET_GPR (OP[0], tmp);
1454   trace_output_16 (tmp);
1455 }
1456
1457 /* ldi.s */
1458 void
1459 OP_4001 ()
1460 {
1461   int16 tmp;
1462   trace_input ("ldi.s", OP_REG_OUTPUT, OP_CONSTANT4, OP_VOID);
1463   tmp = SEXT4 (OP[1]);
1464   SET_GPR (OP[0], tmp);
1465   trace_output_16 (tmp);
1466 }
1467
1468 /* ldi.l */
1469 void
1470 OP_20000000 ()
1471 {
1472   int16 tmp;
1473   trace_input ("ldi.l", OP_REG_OUTPUT, OP_CONSTANT16, OP_VOID);
1474   tmp = OP[1];
1475   SET_GPR (OP[0], tmp);
1476   trace_output_16 (tmp);
1477 }
1478
1479 /* ldub */
1480 void
1481 OP_39000000 ()
1482 {
1483   int16 tmp;
1484   trace_input ("ldub", OP_REG_OUTPUT, OP_MEMREF2, OP_VOID);
1485   tmp = RB (OP[1] + GPR (OP[2]));
1486   SET_GPR (OP[0], tmp);
1487   trace_output_16 (tmp);
1488 }
1489
1490 /* ldub */
1491 void
1492 OP_7200 ()
1493 {
1494   int16 tmp;
1495   trace_input ("ldub", OP_REG_OUTPUT, OP_MEMREF, OP_VOID);
1496   tmp = RB (GPR (OP[1]));
1497   SET_GPR (OP[0], tmp);
1498   trace_output_16 (tmp);
1499 }
1500
1501 /* mac */
1502 void
1503 OP_2A00 ()
1504 {
1505   int64 tmp;
1506
1507   trace_input ("mac", OP_ACCUM, OP_REG, OP_REG);
1508   tmp = SEXT40 ((int16)(GPR (OP[1])) * (int16)(GPR (OP[2])));
1509
1510   if (PSW_FX)
1511     tmp = SEXT40( (tmp << 1) & MASK40);
1512
1513   if (PSW_ST && tmp > SEXT40(MAX32))
1514     tmp = (MAX32);
1515
1516   tmp += SEXT40 (ACC (OP[0]));
1517   if (PSW_ST)
1518     {
1519       if (tmp > SEXT40(MAX32))
1520         tmp = (MAX32);
1521       else if (tmp < SEXT40(MIN32))
1522         tmp = (MIN32);
1523       else
1524         tmp = (tmp & MASK40);
1525     }
1526   else
1527     tmp = (tmp & MASK40);
1528   SET_ACC (OP[0], tmp);
1529   trace_output_40 (tmp);
1530 }
1531
1532 /* macsu */
1533 void
1534 OP_1A00 ()
1535 {
1536   int64 tmp;
1537
1538   trace_input ("macsu", OP_ACCUM, OP_REG, OP_REG);
1539   tmp = SEXT40 ((int16) GPR (OP[1]) * GPR (OP[2]));
1540   if (PSW_FX)
1541     tmp = SEXT40 ((tmp << 1) & MASK40);
1542   tmp = ((SEXT40 (ACC (OP[0])) + tmp) & MASK40);
1543   SET_ACC (OP[0], tmp);
1544   trace_output_40 (tmp);
1545 }
1546
1547 /* macu */
1548 void
1549 OP_3A00 ()
1550 {
1551   uint64 tmp;
1552   uint32 src1;
1553   uint32 src2;
1554
1555   trace_input ("macu", OP_ACCUM, OP_REG, OP_REG);
1556   src1 = (uint16) GPR (OP[1]);
1557   src2 = (uint16) GPR (OP[2]);
1558   tmp = src1 * src2;
1559   if (PSW_FX)
1560     tmp = (tmp << 1);
1561   tmp = ((ACC (OP[0]) + tmp) & MASK40);
1562   SET_ACC (OP[0], tmp);
1563   trace_output_40 (tmp);
1564 }
1565
1566 /* max */
1567 void
1568 OP_2600 ()
1569 {
1570   int16 tmp;
1571   trace_input ("max", OP_REG, OP_REG, OP_VOID);
1572   SET_PSW_F1 (PSW_F0);
1573   if ((int16) GPR (OP[1]) > (int16)GPR (OP[0]))
1574     {
1575       tmp = GPR (OP[1]);
1576       SET_PSW_F0 (1);
1577     }
1578   else
1579     {
1580       tmp = GPR (OP[0]);
1581       SET_PSW_F0 (0);
1582     }
1583   SET_GPR (OP[0], tmp);
1584   trace_output_16 (tmp);
1585 }
1586
1587 /* max */
1588 void
1589 OP_3600 ()
1590 {
1591   int64 tmp;
1592
1593   trace_input ("max", OP_ACCUM, OP_DREG, OP_VOID);
1594   SET_PSW_F1 (PSW_F0);
1595   tmp = SEXT16 (GPR (OP[1])) << 16 | GPR (OP[1] + 1);
1596   if (tmp > SEXT40 (ACC (OP[0])))
1597     {
1598       tmp = (tmp & MASK40);
1599       SET_PSW_F0 (1);
1600     }
1601   else
1602     {
1603       tmp = ACC (OP[0]);
1604       SET_PSW_F0 (0);
1605     }
1606   SET_ACC (OP[0], tmp);
1607   trace_output_40 (tmp);
1608 }
1609
1610 /* max */
1611 void
1612 OP_3602 ()
1613 {
1614   int64 tmp;
1615   trace_input ("max", OP_ACCUM, OP_ACCUM, OP_VOID);
1616   SET_PSW_F1 (PSW_F0);
1617   if (SEXT40 (ACC (OP[1])) > SEXT40 (ACC (OP[0])))
1618     {
1619       tmp = ACC (OP[1]);
1620       SET_PSW_F0 (1);
1621     }
1622   else
1623     {
1624       tmp = ACC (OP[0]);
1625       SET_PSW_F0 (0);
1626     }
1627   SET_ACC (OP[0], tmp);
1628   trace_output_40 (tmp);
1629 }
1630
1631
1632 /* min */
1633 void
1634 OP_2601 ()
1635 {
1636   int16 tmp;
1637   trace_input ("min", OP_REG, OP_REG, OP_VOID);
1638   SET_PSW_F1 (PSW_F0);
1639   if ((int16)GPR (OP[1]) < (int16)GPR (OP[0]))
1640     {
1641       tmp = GPR (OP[1]);
1642       SET_PSW_F0 (1);
1643     }
1644   else
1645     {
1646       tmp = GPR (OP[0]);
1647       SET_PSW_F0 (0);
1648     }
1649   SET_GPR (OP[0], tmp);
1650   trace_output_16 (tmp);
1651 }
1652
1653 /* min */
1654 void
1655 OP_3601 ()
1656 {
1657   int64 tmp;
1658
1659   trace_input ("min", OP_ACCUM, OP_DREG, OP_VOID);
1660   SET_PSW_F1 (PSW_F0);
1661   tmp = SEXT16 (GPR (OP[1])) << 16 | GPR (OP[1] + 1);
1662   if (tmp < SEXT40(ACC (OP[0])))
1663     {
1664       tmp = (tmp & MASK40);
1665       SET_PSW_F0 (1);
1666     }
1667   else
1668     {
1669       tmp = ACC (OP[0]);
1670       SET_PSW_F0 (0);
1671     }
1672   SET_ACC (OP[0], tmp);
1673   trace_output_40 (tmp);
1674 }
1675
1676 /* min */
1677 void
1678 OP_3603 ()
1679 {
1680   int64 tmp;
1681   trace_input ("min", OP_ACCUM, OP_ACCUM, OP_VOID);
1682   SET_PSW_F1 (PSW_F0);
1683   if (SEXT40(ACC (OP[1])) < SEXT40(ACC (OP[0])))
1684     {
1685       tmp = ACC (OP[1]);
1686       SET_PSW_F0 (1);
1687     }
1688   else
1689     {
1690       tmp = ACC (OP[0]);
1691       SET_PSW_F0 (0);
1692     }
1693   SET_ACC (OP[0], tmp);
1694   trace_output_40 (tmp);
1695 }
1696
1697 /* msb */
1698 void
1699 OP_2800 ()
1700 {
1701   int64 tmp;
1702
1703   trace_input ("msb", OP_ACCUM, OP_REG, OP_REG);
1704   tmp = SEXT40 ((int16)(GPR (OP[1])) * (int16)(GPR (OP[2])));
1705
1706   if (PSW_FX)
1707     tmp = SEXT40 ((tmp << 1) & MASK40);
1708
1709   if (PSW_ST && tmp > SEXT40(MAX32))
1710     tmp = (MAX32);
1711
1712   tmp = SEXT40(ACC (OP[0])) - tmp;
1713   if (PSW_ST)
1714     {
1715       if (tmp > SEXT40(MAX32))
1716         tmp = (MAX32);
1717       else if (tmp < SEXT40(MIN32))
1718         tmp = (MIN32);
1719       else
1720         tmp = (tmp & MASK40);
1721     }
1722   else
1723     {
1724       tmp = (tmp & MASK40);
1725     }
1726   SET_ACC (OP[0], tmp);
1727   trace_output_40 (tmp);
1728 }
1729
1730 /* msbsu */
1731 void
1732 OP_1800 ()
1733 {
1734   int64 tmp;
1735
1736   trace_input ("msbsu", OP_ACCUM, OP_REG, OP_REG);
1737   tmp = SEXT40 ((int16)GPR (OP[1]) * GPR (OP[2]));
1738   if (PSW_FX)
1739     tmp = SEXT40( (tmp << 1) & MASK40);
1740   tmp = ((SEXT40 (ACC (OP[0])) - tmp) & MASK40);
1741   SET_ACC (OP[0], tmp);
1742   trace_output_40 (tmp);
1743 }
1744
1745 /* msbu */
1746 void
1747 OP_3800 ()
1748 {
1749   uint64 tmp;
1750   uint32 src1;
1751   uint32 src2;
1752
1753   trace_input ("msbu", OP_ACCUM, OP_REG, OP_REG);
1754   src1 = (uint16) GPR (OP[1]);
1755   src2 = (uint16) GPR (OP[2]);
1756   tmp = src1 * src2;
1757   if (PSW_FX)
1758     tmp = (tmp << 1);
1759   tmp = ((ACC (OP[0]) - tmp) & MASK40);
1760   SET_ACC (OP[0], tmp);
1761   trace_output_40 (tmp);
1762 }
1763
1764 /* mul */
1765 void
1766 OP_2E00 ()
1767 {
1768   int16 tmp;
1769   trace_input ("mul", OP_REG, OP_REG, OP_VOID);
1770   tmp = GPR (OP[0]) * GPR (OP[1]);
1771   SET_GPR (OP[0], tmp);
1772   trace_output_16 (tmp);
1773 }
1774
1775 /* mulx */
1776 void
1777 OP_2C00 ()
1778 {
1779   int64 tmp;
1780
1781   trace_input ("mulx", OP_ACCUM_OUTPUT, OP_REG, OP_REG);
1782   tmp = SEXT40 ((int16)(GPR (OP[1])) * (int16)(GPR (OP[2])));
1783
1784   if (PSW_FX)
1785     tmp = SEXT40 ((tmp << 1) & MASK40);
1786
1787   if (PSW_ST && tmp > SEXT40(MAX32))
1788     tmp = (MAX32);
1789   else
1790     tmp = (tmp & MASK40);
1791   SET_ACC (OP[0], tmp);
1792   trace_output_40 (tmp);
1793 }
1794
1795 /* mulxsu */
1796 void
1797 OP_1C00 ()
1798 {
1799   int64 tmp;
1800
1801   trace_input ("mulxsu", OP_ACCUM_OUTPUT, OP_REG, OP_REG);
1802   tmp = SEXT40 ((int16)(GPR (OP[1])) * GPR (OP[2]));
1803
1804   if (PSW_FX)
1805     tmp <<= 1;
1806   tmp = (tmp & MASK40);
1807   SET_ACC (OP[0], tmp);
1808   trace_output_40 (tmp);
1809 }
1810
1811 /* mulxu */
1812 void
1813 OP_3C00 ()
1814 {
1815   uint64 tmp;
1816   uint32 src1;
1817   uint32 src2;
1818
1819   trace_input ("mulxu", OP_ACCUM_OUTPUT, OP_REG, OP_REG);
1820   src1 = (uint16) GPR (OP[1]);
1821   src2 = (uint16) GPR (OP[2]);
1822   tmp = src1 * src2;
1823   if (PSW_FX)
1824     tmp <<= 1;
1825   tmp = (tmp & MASK40);
1826   SET_ACC (OP[0], tmp);
1827   trace_output_40 (tmp);
1828 }
1829
1830 /* mv */
1831 void
1832 OP_4000 ()
1833 {
1834   int16 tmp;
1835   trace_input ("mv", OP_REG_OUTPUT, OP_REG, OP_VOID);
1836   tmp = GPR (OP[1]);
1837   SET_GPR (OP[0], tmp);
1838   trace_output_16 (tmp);
1839 }
1840
1841 /* mv2w */
1842 void
1843 OP_5000 ()
1844 {
1845   int32 tmp;
1846   trace_input ("mv2w", OP_DREG_OUTPUT, OP_DREG, OP_VOID);
1847   tmp = GPR32 (OP[1]);
1848   SET_GPR32 (OP[0], tmp);
1849   trace_output_32 (tmp);
1850 }
1851
1852 /* mv2wfac */
1853 void
1854 OP_3E00 ()
1855 {
1856   int32 tmp;
1857   trace_input ("mv2wfac", OP_DREG_OUTPUT, OP_ACCUM, OP_VOID);
1858   tmp = ACC (OP[1]);
1859   SET_GPR32 (OP[0], tmp);
1860   trace_output_32 (tmp);
1861 }
1862
1863 /* mv2wtac */
1864 void
1865 OP_3E01 ()
1866 {
1867   int64 tmp;
1868   trace_input ("mv2wtac", OP_DREG, OP_ACCUM_OUTPUT, OP_VOID);
1869   tmp = ((SEXT16 (GPR (OP[0])) << 16 | GPR (OP[0] + 1)) & MASK40);
1870   SET_ACC (OP[1], tmp);
1871   trace_output_40 (tmp);
1872 }
1873
1874 /* mvac */
1875 void
1876 OP_3E03 ()
1877 {
1878   int64 tmp;
1879   trace_input ("mvac", OP_ACCUM_OUTPUT, OP_ACCUM, OP_VOID);
1880   tmp = ACC (OP[1]);
1881   SET_ACC (OP[0], tmp);
1882   trace_output_40 (tmp);
1883 }
1884
1885 /* mvb */
1886 void
1887 OP_5400 ()
1888 {
1889   int16 tmp;
1890   trace_input ("mvb", OP_REG_OUTPUT, OP_REG, OP_VOID);
1891   tmp = SEXT8 (GPR (OP[1]) & 0xff);
1892   SET_GPR (OP[0], tmp);
1893   trace_output_16 (tmp);
1894 }
1895
1896 /* mvf0f */
1897 void
1898 OP_4400 ()
1899 {
1900   int16 tmp;
1901   trace_input ("mf0f", OP_REG_OUTPUT, OP_REG, OP_VOID);
1902   if (PSW_F0 == 0)
1903     {
1904       tmp = GPR (OP[1]);
1905       SET_GPR (OP[0], tmp);
1906     }
1907   else
1908     tmp = GPR (OP[0]);
1909   trace_output_16 (tmp);
1910 }
1911
1912 /* mvf0t */
1913 void
1914 OP_4401 ()
1915 {
1916   int16 tmp;
1917   trace_input ("mf0t", OP_REG_OUTPUT, OP_REG, OP_VOID);
1918   if (PSW_F0)
1919     {
1920       tmp = GPR (OP[1]);
1921       SET_GPR (OP[0], tmp);
1922     }
1923   else
1924     tmp = GPR (OP[0]);
1925   trace_output_16 (tmp);
1926 }
1927
1928 /* mvfacg */
1929 void
1930 OP_1E04 ()
1931 {
1932   int16 tmp;
1933   trace_input ("mvfacg", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
1934   tmp = ((ACC (OP[1]) >> 32) & 0xff);
1935   SET_GPR (OP[0], tmp);
1936   trace_output_16 (tmp);
1937 }
1938
1939 /* mvfachi */
1940 void
1941 OP_1E00 ()
1942 {
1943   int16 tmp;
1944   trace_input ("mvfachi", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
1945   tmp = (ACC (OP[1]) >> 16);
1946   SET_GPR (OP[0], tmp);
1947   trace_output_16 (tmp);
1948 }
1949
1950 /* mvfaclo */
1951 void
1952 OP_1E02 ()
1953 {
1954   int16 tmp;
1955   trace_input ("mvfaclo", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
1956   tmp = ACC (OP[1]);
1957   SET_GPR (OP[0], tmp);
1958   trace_output_16 (tmp);
1959 }
1960
1961 /* mvfc */
1962 void
1963 OP_5200 ()
1964 {
1965   int16 tmp;
1966   trace_input ("mvfc", OP_REG_OUTPUT, OP_CR, OP_VOID);
1967   tmp = CREG (OP[1]);
1968   SET_GPR (OP[0], tmp);
1969   trace_output_16 (tmp);
1970 }
1971
1972 /* mvtacg */
1973 void
1974 OP_1E41 ()
1975 {
1976   int64 tmp;
1977   trace_input ("mvtacg", OP_REG, OP_ACCUM, OP_VOID);
1978   tmp = ((ACC (OP[1]) & MASK32)
1979          | ((int64)(GPR (OP[0]) & 0xff) << 32));
1980   SET_ACC (OP[1], tmp);
1981   trace_output_40 (tmp);
1982 }
1983
1984 /* mvtachi */
1985 void
1986 OP_1E01 ()
1987 {
1988   uint64 tmp;
1989   trace_input ("mvtachi", OP_REG, OP_ACCUM, OP_VOID);
1990   tmp = ACC (OP[1]) & 0xffff;
1991   tmp = ((SEXT16 (GPR (OP[0])) << 16 | tmp) & MASK40);
1992   SET_ACC (OP[1], tmp);
1993   trace_output_40 (tmp);
1994 }
1995
1996 /* mvtaclo */
1997 void
1998 OP_1E21 ()
1999 {
2000   int64 tmp;
2001   trace_input ("mvtaclo", OP_REG, OP_ACCUM, OP_VOID);
2002   tmp = ((SEXT16 (GPR (OP[0]))) & MASK40);
2003   SET_ACC (OP[1], tmp);
2004   trace_output_40 (tmp);
2005 }
2006
2007 /* mvtc */
2008 void
2009 OP_5600 ()
2010 {
2011   int16 tmp;
2012   trace_input ("mvtc", OP_REG, OP_CR_OUTPUT, OP_VOID);
2013   tmp = GPR (OP[0]);
2014   tmp = SET_CREG (OP[1], tmp);
2015   trace_output_16 (tmp);
2016 }
2017
2018 /* mvub */
2019 void
2020 OP_5401 ()
2021 {
2022   int16 tmp;
2023   trace_input ("mvub", OP_REG_OUTPUT, OP_REG, OP_VOID);
2024   tmp = (GPR (OP[1]) & 0xff);
2025   SET_GPR (OP[0], tmp);
2026   trace_output_16 (tmp);
2027 }
2028
2029 /* neg */
2030 void
2031 OP_4605 ()
2032 {
2033   int16 tmp;
2034   trace_input ("neg", OP_REG, OP_VOID, OP_VOID);
2035   tmp = - GPR (OP[0]);
2036   SET_GPR (OP[0], tmp);
2037   trace_output_16 (tmp);
2038 }
2039
2040 /* neg */
2041 void
2042 OP_5605 ()
2043 {
2044   int64 tmp;
2045
2046   trace_input ("neg", OP_ACCUM, OP_VOID, OP_VOID);
2047   tmp = -SEXT40(ACC (OP[0]));
2048   if (PSW_ST)
2049     {
2050       if (tmp > SEXT40(MAX32))
2051         tmp = (MAX32);
2052       else if (tmp < SEXT40(MIN32))
2053         tmp = (MIN32);
2054       else
2055         tmp = (tmp & MASK40);
2056     }
2057   else
2058     tmp = (tmp & MASK40);
2059   SET_ACC (OP[0], tmp);
2060   trace_output_40 (tmp);
2061 }
2062
2063
2064 /* nop */
2065 void
2066 OP_5E00 ()
2067 {
2068   trace_input ("nop", OP_VOID, OP_VOID, OP_VOID);
2069
2070   ins_type_counters[ (int)State.ins_type ]--;   /* don't count nops as normal instructions */
2071   switch (State.ins_type)
2072     {
2073     default:
2074       ins_type_counters[ (int)INS_UNKNOWN ]++;
2075       break;
2076
2077     case INS_LEFT_PARALLEL:
2078       /* Don't count a parallel op that includes a NOP as a true parallel op */
2079       ins_type_counters[ (int)INS_RIGHT_PARALLEL ]--;
2080       ins_type_counters[ (int)INS_RIGHT ]++;
2081       ins_type_counters[ (int)INS_LEFT_NOPS ]++;
2082       break;
2083
2084     case INS_LEFT:
2085     case INS_LEFT_COND_EXE:
2086       ins_type_counters[ (int)INS_LEFT_NOPS ]++;
2087       break;
2088
2089     case INS_RIGHT_PARALLEL:
2090       /* Don't count a parallel op that includes a NOP as a true parallel op */
2091       ins_type_counters[ (int)INS_LEFT_PARALLEL ]--;
2092       ins_type_counters[ (int)INS_LEFT ]++;
2093       ins_type_counters[ (int)INS_RIGHT_NOPS ]++;
2094       break;
2095
2096     case INS_RIGHT:
2097     case INS_RIGHT_COND_EXE:
2098       ins_type_counters[ (int)INS_RIGHT_NOPS ]++;
2099       break;
2100     }
2101
2102   trace_output_void ();
2103 }
2104
2105 /* not */
2106 void
2107 OP_4603 ()
2108 {
2109   int16 tmp;
2110   trace_input ("not", OP_REG, OP_VOID, OP_VOID);
2111   tmp = ~GPR (OP[0]);
2112   SET_GPR (OP[0], tmp);
2113   trace_output_16 (tmp);
2114 }
2115
2116 /* or */
2117 void
2118 OP_800 ()
2119 {
2120   int16 tmp;
2121   trace_input ("or", OP_REG, OP_REG, OP_VOID);
2122   tmp = (GPR (OP[0]) | GPR (OP[1]));
2123   SET_GPR (OP[0], tmp);
2124   trace_output_16 (tmp);
2125 }
2126
2127 /* or3 */
2128 void
2129 OP_4000000 ()
2130 {
2131   int16 tmp;
2132   trace_input ("or3", OP_REG_OUTPUT, OP_REG, OP_CONSTANT16);
2133   tmp = (GPR (OP[1]) | OP[2]);
2134   SET_GPR (OP[0], tmp);
2135   trace_output_16 (tmp);
2136 }
2137
2138 /* rac */
2139 void
2140 OP_5201 ()
2141 {
2142   int64 tmp;
2143   int shift = SEXT3 (OP[2]);
2144
2145   trace_input ("rac", OP_DREG_OUTPUT, OP_ACCUM, OP_CONSTANT3);
2146   if (OP[1] != 0)
2147     {
2148       (*d10v_callback->printf_filtered) (d10v_callback,
2149                                          "ERROR at PC 0x%x: instruction only valid for A0\n",
2150                                          PC<<2);
2151       State.exception = SIGILL;
2152     }
2153
2154   SET_PSW_F1 (PSW_F0);
2155   tmp = SEXT56 ((ACC (0) << 16) | (ACC (1) & 0xffff));
2156   if (shift >=0)
2157     tmp <<= shift;
2158   else
2159     tmp >>= -shift;
2160   tmp += 0x8000;
2161   tmp >>= 16; /* look at bits 0:43 */
2162   if (tmp > SEXT44 (SIGNED64 (0x0007fffffff)))
2163     {
2164       tmp = 0x7fffffff;
2165       SET_PSW_F0 (1);
2166     }
2167   else if (tmp < SEXT44 (SIGNED64 (0xfff80000000)))
2168     {
2169       tmp = 0x80000000;
2170       SET_PSW_F0 (1);
2171     }
2172   else
2173     {
2174       SET_PSW_F0 (0);
2175     }
2176   SET_GPR32 (OP[0], tmp);
2177   trace_output_32 (tmp);
2178 }
2179
2180 /* rachi */
2181 void
2182 OP_4201 ()
2183 {
2184   signed64 tmp;
2185   int shift = SEXT3 (OP[2]);
2186
2187   trace_input ("rachi", OP_REG_OUTPUT, OP_ACCUM, OP_CONSTANT3);
2188   SET_PSW_F1 (PSW_F0);
2189   if (shift >=0)
2190     tmp = SEXT40 (ACC (OP[1])) << shift;
2191   else
2192     tmp = SEXT40 (ACC (OP[1])) >> -shift;
2193   tmp += 0x8000;
2194
2195   if (tmp > SEXT44 (SIGNED64 (0x0007fffffff)))
2196     {
2197       tmp = 0x7fff;
2198       SET_PSW_F0 (1);
2199     }
2200   else if (tmp < SEXT44 (SIGNED64 (0xfff80000000)))
2201     {
2202       tmp = 0x8000;
2203       SET_PSW_F0 (1);
2204     }
2205   else
2206     {
2207       tmp = (tmp >> 16);
2208       SET_PSW_F0 (0);
2209     }
2210   SET_GPR (OP[0], tmp);
2211   trace_output_16 (tmp);
2212 }
2213
2214 /* rep */
2215 void
2216 OP_27000000 ()
2217 {
2218   trace_input ("rep", OP_REG, OP_CONSTANT16, OP_VOID);
2219   SET_RPT_S (PC + 1);
2220   SET_RPT_E (PC + OP[1]);
2221   SET_RPT_C (GPR (OP[0]));
2222   SET_PSW_RP (1);
2223   if (GPR (OP[0]) == 0)
2224     {
2225       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: rep with count=0 is illegal.\n");
2226       State.exception = SIGILL;
2227     }
2228   if (OP[1] < 4)
2229     {
2230       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: rep must include at least 4 instructions.\n");
2231       State.exception = SIGILL;
2232     }
2233   trace_output_void ();
2234 }
2235
2236 /* repi */
2237 void
2238 OP_2F000000 ()
2239 {
2240   trace_input ("repi", OP_CONSTANT16, OP_CONSTANT16, OP_VOID);
2241   SET_RPT_S (PC + 1);
2242   SET_RPT_E (PC + OP[1]);
2243   SET_RPT_C (OP[0]);
2244   SET_PSW_RP (1);
2245   if (OP[0] == 0)
2246     {
2247       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: repi with count=0 is illegal.\n");
2248       State.exception = SIGILL;
2249     }
2250   if (OP[1] < 4)
2251     {
2252       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: repi must include at least 4 instructions.\n");
2253       State.exception = SIGILL;
2254     }
2255   trace_output_void ();
2256 }
2257
2258 /* rtd */
2259 void
2260 OP_5F60 ()
2261 {
2262   trace_input ("rtd", OP_VOID, OP_VOID, OP_VOID);
2263   SET_CREG (PSW_CR, DPSW);
2264   JMP(DPC);
2265   trace_output_void ();
2266 }
2267
2268 /* rte */
2269 void
2270 OP_5F40 ()
2271 {
2272   trace_input ("rte", OP_VOID, OP_VOID, OP_VOID);
2273   SET_CREG (PSW_CR, BPSW);
2274   JMP(BPC);
2275   trace_output_void ();
2276 }
2277
2278 /* sac */
2279 void OP_5209 ()
2280 {
2281   int64 tmp;
2282
2283   trace_input ("sac", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
2284
2285   tmp = SEXT40(ACC (OP[1]));
2286
2287   SET_PSW_F1 (PSW_F0);
2288
2289   if (tmp > SEXT40(MAX32))
2290     {
2291       tmp = (MAX32);
2292       SET_PSW_F0 (1);
2293     }
2294   else if (tmp < SEXT40(MIN32))
2295     {
2296       tmp = 0x80000000;
2297       SET_PSW_F0 (1);
2298     }
2299   else
2300     {
2301       tmp = (tmp & MASK32);
2302       SET_PSW_F0 (0);
2303     }
2304
2305   SET_GPR32 (OP[0], tmp);
2306
2307   trace_output_40 (tmp);
2308 }
2309
2310 /* sachi */
2311 void
2312 OP_4209 ()
2313 {
2314   int64 tmp;
2315
2316   trace_input ("sachi", OP_REG_OUTPUT, OP_ACCUM, OP_VOID);
2317
2318   tmp = SEXT40(ACC (OP[1]));
2319
2320   SET_PSW_F1 (PSW_F0);
2321
2322   if (tmp > SEXT40(MAX32))
2323     {
2324       tmp = 0x7fff;
2325       SET_PSW_F0 (1);
2326     }
2327   else if (tmp < SEXT40(MIN32))
2328     {
2329       tmp = 0x8000;
2330       SET_PSW_F0 (1);
2331     }
2332   else
2333     {
2334       tmp >>= 16;
2335       SET_PSW_F0 (0);
2336     }
2337
2338   SET_GPR (OP[0], tmp);
2339
2340   trace_output_16 (OP[0]);
2341 }
2342
2343 /* sadd */
2344 void
2345 OP_1223 ()
2346 {
2347   int64 tmp;
2348
2349   trace_input ("sadd", OP_ACCUM, OP_ACCUM, OP_VOID);
2350   tmp = SEXT40(ACC (OP[0])) + (SEXT40(ACC (OP[1])) >> 16);
2351   if (PSW_ST)
2352     {
2353       if (tmp > SEXT40(MAX32))
2354         tmp = (MAX32);
2355       else if (tmp < SEXT40(MIN32))
2356         tmp = (MIN32);
2357       else
2358         tmp = (tmp & MASK40);
2359     }
2360   else
2361     tmp = (tmp & MASK40);
2362   SET_ACC (OP[0], tmp);
2363   trace_output_40 (tmp);
2364 }
2365
2366 /* setf0f */
2367 void
2368 OP_4611 ()
2369 {
2370   int16 tmp;
2371   trace_input ("setf0f", OP_REG_OUTPUT, OP_VOID, OP_VOID);
2372   tmp = ((PSW_F0 == 0) ? 1 : 0);
2373   SET_GPR (OP[0], tmp);
2374   trace_output_16 (tmp);
2375 }
2376
2377 /* setf0t */
2378 void
2379 OP_4613 ()
2380 {
2381   int16 tmp;
2382   trace_input ("setf0t", OP_REG_OUTPUT, OP_VOID, OP_VOID);
2383   tmp = ((PSW_F0 == 1) ? 1 : 0);
2384   SET_GPR (OP[0], tmp);
2385   trace_output_16 (tmp);
2386 }
2387
2388 /* slae */
2389 void
2390 OP_3220 ()
2391 {
2392   int64 tmp;
2393   int16 reg;
2394
2395   trace_input ("slae", OP_ACCUM, OP_REG, OP_VOID);
2396
2397   reg = SEXT16 (GPR (OP[1]));
2398
2399   if (reg >= 17 || reg <= -17)
2400     {
2401       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: shift value %d too large.\n", reg);
2402       State.exception = SIGILL;
2403       return;
2404     }
2405
2406   tmp = SEXT40 (ACC (OP[0]));
2407
2408   if (PSW_ST && (tmp < SEXT40 (MIN32) || tmp > SEXT40 (MAX32)))
2409     {
2410       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: accumulator value 0x%.2x%.8lx out of range\n", ((int)(tmp >> 32) & 0xff), ((unsigned long) tmp) & 0xffffffff);
2411       State.exception = SIGILL;
2412       return;
2413     }
2414
2415   if (reg >= 0 && reg <= 16)
2416     {
2417       tmp = SEXT56 ((SEXT56 (tmp)) << (GPR (OP[1])));
2418       if (PSW_ST)
2419         {
2420           if (tmp > SEXT40(MAX32))
2421             tmp = (MAX32);
2422           else if (tmp < SEXT40(MIN32))
2423             tmp = (MIN32);
2424           else
2425             tmp = (tmp & MASK40);
2426         }
2427       else
2428         tmp = (tmp & MASK40);
2429     }
2430   else
2431     {
2432       tmp = (SEXT40 (ACC (OP[0]))) >> (-GPR (OP[1]));
2433     }
2434
2435   SET_ACC(OP[0], tmp);
2436
2437   trace_output_40(tmp);
2438 }
2439
2440 /* sleep */
2441 void
2442 OP_5FC0 ()
2443 {
2444   trace_input ("sleep", OP_VOID, OP_VOID, OP_VOID);
2445   SET_PSW_IE (1);
2446   trace_output_void ();
2447 }
2448
2449 /* sll */
2450 void
2451 OP_2200 ()
2452 {
2453   int16 tmp;
2454   trace_input ("sll", OP_REG, OP_REG, OP_VOID);
2455   tmp = (GPR (OP[0]) << (GPR (OP[1]) & 0xf));
2456   SET_GPR (OP[0], tmp);
2457   trace_output_16 (tmp);
2458 }
2459
2460 /* sll */
2461 void
2462 OP_3200 ()
2463 {
2464   int64 tmp;
2465   trace_input ("sll", OP_ACCUM, OP_REG, OP_VOID);
2466   if ((GPR (OP[1]) & 31) <= 16)
2467     tmp = SEXT40 (ACC (OP[0])) << (GPR (OP[1]) & 31);
2468   else
2469     {
2470       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: shift value %d too large.\n", GPR (OP[1]) & 31);
2471       State.exception = SIGILL;
2472       return;
2473     }
2474
2475   if (PSW_ST)
2476     {
2477       if (tmp > SEXT40(MAX32))
2478         tmp = (MAX32);
2479       else if (tmp < SEXT40(MIN32))
2480         tmp = (MIN32);
2481       else
2482         tmp = (tmp & MASK40);
2483     }
2484   else
2485     tmp = (tmp & MASK40);
2486   SET_ACC (OP[0], tmp);
2487   trace_output_40 (tmp);
2488 }
2489
2490 /* slli */
2491 void
2492 OP_2201 ()
2493 {
2494   int16 tmp;
2495   trace_input ("slli", OP_REG, OP_CONSTANT16, OP_VOID);
2496   tmp = (GPR (OP[0]) << OP[1]);
2497   SET_GPR (OP[0], tmp);
2498   trace_output_16 (tmp);
2499 }
2500
2501 /* slli */
2502 void
2503 OP_3201 ()
2504 {
2505   int64 tmp;
2506
2507   if (OP[1] == 0)
2508     OP[1] = 16;
2509
2510   trace_input ("slli", OP_ACCUM, OP_CONSTANT16, OP_VOID);
2511   tmp = SEXT40(ACC (OP[0])) << OP[1];
2512
2513   if (PSW_ST)
2514     {
2515       if (tmp > SEXT40(MAX32))
2516         tmp = (MAX32);
2517       else if (tmp < SEXT40(MIN32))
2518         tmp = (MIN32);
2519       else
2520         tmp = (tmp & MASK40);
2521     }
2522   else
2523     tmp = (tmp & MASK40);
2524   SET_ACC (OP[0], tmp);
2525   trace_output_40 (tmp);
2526 }
2527
2528 /* slx */
2529 void
2530 OP_460B ()
2531 {
2532   int16 tmp;
2533   trace_input ("slx", OP_REG, OP_FLAG, OP_VOID);
2534   tmp = ((GPR (OP[0]) << 1) | PSW_F0);
2535   SET_GPR (OP[0], tmp);
2536   trace_output_16 (tmp);
2537 }
2538
2539 /* sra */
2540 void
2541 OP_2400 ()
2542 {
2543   int16 tmp;
2544   trace_input ("sra", OP_REG, OP_REG, OP_VOID);
2545   tmp = (((int16)(GPR (OP[0]))) >> (GPR (OP[1]) & 0xf));
2546   SET_GPR (OP[0], tmp);
2547   trace_output_16 (tmp);
2548 }
2549
2550 /* sra */
2551 void
2552 OP_3400 ()
2553 {
2554   trace_input ("sra", OP_ACCUM, OP_REG, OP_VOID);
2555   if ((GPR (OP[1]) & 31) <= 16)
2556     {
2557       int64 tmp = ((SEXT40(ACC (OP[0])) >> (GPR (OP[1]) & 31)) & MASK40);
2558       SET_ACC (OP[0], tmp);
2559       trace_output_40 (tmp);
2560     }
2561   else
2562     {
2563       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: shift value %d too large.\n", GPR (OP[1]) & 31);
2564       State.exception = SIGILL;
2565       return;
2566     }
2567 }
2568
2569 /* srai */
2570 void
2571 OP_2401 ()
2572 {
2573   int16 tmp;
2574   trace_input ("srai", OP_REG, OP_CONSTANT16, OP_VOID);
2575   tmp = (((int16)(GPR (OP[0]))) >> OP[1]);
2576   SET_GPR (OP[0], tmp);
2577   trace_output_16 (tmp);
2578 }
2579
2580 /* srai */
2581 void
2582 OP_3401 ()
2583 {
2584   int64 tmp;
2585   if (OP[1] == 0)
2586     OP[1] = 16;
2587
2588   trace_input ("srai", OP_ACCUM, OP_CONSTANT16, OP_VOID);
2589   tmp = ((SEXT40(ACC (OP[0])) >> OP[1]) & MASK40);
2590   SET_ACC (OP[0], tmp);
2591   trace_output_40 (tmp);
2592 }
2593
2594 /* srl */
2595 void
2596 OP_2000 ()
2597 {
2598   int16 tmp;
2599   trace_input ("srl", OP_REG, OP_REG, OP_VOID);
2600   tmp = (GPR (OP[0]) >>  (GPR (OP[1]) & 0xf));
2601   SET_GPR (OP[0], tmp);
2602   trace_output_16 (tmp);
2603 }
2604
2605 /* srl */
2606 void
2607 OP_3000 ()
2608 {
2609   trace_input ("srl", OP_ACCUM, OP_REG, OP_VOID);
2610   if ((GPR (OP[1]) & 31) <= 16)
2611     {
2612       int64 tmp = ((uint64)((ACC (OP[0]) & MASK40) >> (GPR (OP[1]) & 31)));
2613       SET_ACC (OP[0], tmp);
2614       trace_output_40 (tmp);
2615     }
2616   else
2617     {
2618       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: shift value %d too large.\n", GPR (OP[1]) & 31);
2619       State.exception = SIGILL;
2620       return;
2621     }
2622
2623 }
2624
2625 /* srli */
2626 void
2627 OP_2001 ()
2628 {
2629   int16 tmp;
2630   trace_input ("srli", OP_REG, OP_CONSTANT16, OP_VOID);
2631   tmp = (GPR (OP[0]) >> OP[1]);
2632   SET_GPR (OP[0], tmp);
2633   trace_output_16 (tmp);
2634 }
2635
2636 /* srli */
2637 void
2638 OP_3001 ()
2639 {
2640   int64 tmp;
2641   if (OP[1] == 0)
2642     OP[1] = 16;
2643
2644   trace_input ("srli", OP_ACCUM, OP_CONSTANT16, OP_VOID);
2645   tmp = ((uint64)(ACC (OP[0]) & MASK40) >> OP[1]);
2646   SET_ACC (OP[0], tmp);
2647   trace_output_40 (tmp);
2648 }
2649
2650 /* srx */
2651 void
2652 OP_4609 ()
2653 {
2654   uint16 tmp;
2655   trace_input ("srx", OP_REG, OP_FLAG, OP_VOID);
2656   tmp = PSW_F0 << 15;
2657   tmp = ((GPR (OP[0]) >> 1) | tmp);
2658   SET_GPR (OP[0], tmp);
2659   trace_output_16 (tmp);
2660 }
2661
2662 /* st */
2663 void
2664 OP_34000000 ()
2665 {
2666   trace_input ("st", OP_REG, OP_MEMREF2, OP_VOID);
2667   SW (OP[1] + GPR (OP[2]), GPR (OP[0]));
2668   trace_output_void ();
2669 }
2670
2671 /* st */
2672 void
2673 OP_6800 ()
2674 {
2675   trace_input ("st", OP_REG, OP_MEMREF, OP_VOID);
2676   SW (GPR (OP[1]), GPR (OP[0]));
2677   trace_output_void ();
2678 }
2679
2680 /* st */
2681 void
2682 OP_6C1F ()
2683 {
2684   uint16 addr = GPR (OP[1]) - 2;
2685   trace_input ("st", OP_REG, OP_PREDEC, OP_VOID);
2686   if (OP[1] != 15)
2687     {
2688       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: cannot pre-decrement any registers but r15 (SP).\n");
2689       State.exception = SIGILL;
2690       return;
2691     }
2692   SW (addr, GPR (OP[0]));
2693   SET_GPR (OP[1], addr);
2694   trace_output_void ();
2695 }
2696
2697 /* st */
2698 void
2699 OP_6801 ()
2700 {
2701   trace_input ("st", OP_REG, OP_POSTINC, OP_VOID);
2702   SW (GPR (OP[1]), GPR (OP[0]));
2703   INC_ADDR (OP[1], 2);
2704   trace_output_void ();
2705 }
2706
2707 /* st */
2708 void
2709 OP_6C01 ()
2710 {
2711   trace_input ("st", OP_REG, OP_POSTDEC, OP_VOID);
2712   if ( OP[1] == 15 )
2713     {
2714       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: cannot post-decrement register r15 (SP).\n");
2715       State.exception = SIGILL;
2716       return;
2717     }
2718   SW (GPR (OP[1]), GPR (OP[0]));
2719   INC_ADDR (OP[1], -2);
2720   trace_output_void ();
2721 }
2722
2723 /* st */
2724 void
2725 OP_36010000 ()
2726 {
2727   trace_input ("st", OP_REG, OP_MEMREF3, OP_VOID);
2728   SW (OP[1], GPR (OP[0]));
2729   trace_output_void ();
2730 }
2731
2732 /* st2w */
2733 void
2734 OP_35000000 ()
2735 {
2736   trace_input ("st2w", OP_DREG, OP_MEMREF2, OP_VOID);
2737   SW (GPR (OP[2])+ OP[1] + 0, GPR (OP[0] + 0));
2738   SW (GPR (OP[2])+ OP[1] + 2, GPR (OP[0] + 1));
2739   trace_output_void ();
2740 }
2741
2742 /* st2w */
2743 void
2744 OP_6A00 ()
2745 {
2746   trace_input ("st2w", OP_DREG, OP_MEMREF, OP_VOID);
2747   SW (GPR (OP[1]) + 0, GPR (OP[0] + 0));
2748   SW (GPR (OP[1]) + 2, GPR (OP[0] + 1));
2749   trace_output_void ();
2750 }
2751
2752 /* st2w */
2753 void
2754 OP_6E1F ()
2755 {
2756   uint16 addr = GPR (OP[1]) - 4;
2757   trace_input ("st2w", OP_DREG, OP_PREDEC, OP_VOID);
2758   if ( OP[1] != 15 )
2759     {
2760       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: cannot pre-decrement any registers but r15 (SP).\n");
2761       State.exception = SIGILL;
2762       return;
2763     }
2764   SW (addr + 0, GPR (OP[0] + 0));
2765   SW (addr + 2, GPR (OP[0] + 1));
2766   SET_GPR (OP[1], addr);
2767   trace_output_void ();
2768 }
2769
2770 /* st2w */
2771 void
2772 OP_6A01 ()
2773 {
2774   trace_input ("st2w", OP_DREG, OP_POSTINC, OP_VOID);
2775   SW (GPR (OP[1]) + 0, GPR (OP[0] + 0));
2776   SW (GPR (OP[1]) + 2, GPR (OP[0] + 1));
2777   INC_ADDR (OP[1], 4);
2778   trace_output_void ();
2779 }
2780
2781 /* st2w */
2782 void
2783 OP_6E01 ()
2784 {
2785   trace_input ("st2w", OP_DREG, OP_POSTDEC, OP_VOID);
2786   if ( OP[1] == 15 )
2787     {
2788       (*d10v_callback->printf_filtered) (d10v_callback, "ERROR: cannot post-decrement register r15 (SP).\n");
2789       State.exception = SIGILL;
2790       return;
2791     }
2792   SW (GPR (OP[1]) + 0, GPR (OP[0] + 0));
2793   SW (GPR (OP[1]) + 2, GPR (OP[0] + 1));
2794   INC_ADDR (OP[1], -4);
2795   trace_output_void ();
2796 }
2797
2798 /* st2w */
2799 void
2800 OP_37010000 ()
2801 {
2802   trace_input ("st2w", OP_DREG, OP_MEMREF3, OP_VOID);
2803   SW (OP [1] + 0, GPR (OP[0] + 0));
2804   SW (OP [1] + 2, GPR (OP[0] + 1));
2805   trace_output_void ();
2806 }
2807
2808 /* stb */
2809 void
2810 OP_3C000000 ()
2811 {
2812   trace_input ("stb", OP_REG, OP_MEMREF2, OP_VOID);
2813   SB (GPR (OP[2]) + OP[1], GPR (OP[0]));
2814   trace_output_void ();
2815 }
2816
2817 /* stb */
2818 void
2819 OP_7800 ()
2820 {
2821   trace_input ("stb", OP_REG, OP_MEMREF, OP_VOID);
2822   SB (GPR (OP[1]), GPR (OP[0]));
2823   trace_output_void ();
2824 }
2825
2826 /* stop */
2827 void
2828 OP_5FE0 ()
2829 {
2830   trace_input ("stop", OP_VOID, OP_VOID, OP_VOID);
2831   State.exception = SIG_D10V_STOP;
2832   trace_output_void ();
2833 }
2834
2835 /* sub */
2836 void
2837 OP_0 ()
2838 {
2839   uint16 a = GPR (OP[0]);
2840   uint16 b = GPR (OP[1]);
2841   uint16 tmp = (a - b);
2842   trace_input ("sub", OP_REG, OP_REG, OP_VOID);
2843   /* see ../common/sim-alu.h for a more extensive discussion on how to
2844      compute the carry/overflow bits. */
2845   SET_PSW_C (a >= b);
2846   SET_GPR (OP[0], tmp);
2847   trace_output_16 (tmp);
2848 }
2849
2850 /* sub */
2851 void
2852 OP_1001 ()
2853 {
2854   int64 tmp;
2855
2856   trace_input ("sub", OP_ACCUM, OP_DREG, OP_VOID);
2857   tmp = SEXT40(ACC (OP[0])) - (SEXT16 (GPR (OP[1])) << 16 | GPR (OP[1] + 1));
2858   if (PSW_ST)
2859     {
2860       if (tmp > SEXT40(MAX32))
2861         tmp = (MAX32);
2862       else if (tmp < SEXT40(MIN32))
2863         tmp = (MIN32);
2864       else
2865         tmp = (tmp & MASK40);
2866     }
2867   else
2868     tmp = (tmp & MASK40);
2869   SET_ACC (OP[0], tmp);
2870
2871   trace_output_40 (tmp);
2872 }
2873
2874 /* sub */
2875
2876 void
2877 OP_1003 ()
2878 {
2879   int64 tmp;
2880
2881   trace_input ("sub", OP_ACCUM, OP_ACCUM, OP_VOID);
2882   tmp = SEXT40(ACC (OP[0])) - SEXT40(ACC (OP[1]));
2883   if (PSW_ST)
2884     {
2885       if (tmp > SEXT40(MAX32))
2886         tmp = (MAX32);
2887       else if (tmp < SEXT40(MIN32))
2888         tmp = (MIN32);
2889       else
2890         tmp = (tmp & MASK40);
2891     }
2892   else
2893     tmp = (tmp & MASK40);
2894   SET_ACC (OP[0], tmp);
2895
2896   trace_output_40 (tmp);
2897 }
2898
2899 /* sub2w */
2900 void
2901 OP_1000 ()
2902 {
2903   uint32 tmp, a, b;
2904
2905   trace_input ("sub2w", OP_DREG, OP_DREG, OP_VOID);
2906   a = (uint32)((GPR (OP[0]) << 16) | GPR (OP[0] + 1));
2907   b = (uint32)((GPR (OP[1]) << 16) | GPR (OP[1] + 1));
2908   /* see ../common/sim-alu.h for a more extensive discussion on how to
2909      compute the carry/overflow bits */
2910   tmp = a - b;
2911   SET_PSW_C (a >= b);
2912   SET_GPR32 (OP[0], tmp);
2913   trace_output_32 (tmp);
2914 }
2915
2916 /* subac3 */
2917 void
2918 OP_17000000 ()
2919 {
2920   int64 tmp;
2921
2922   trace_input ("subac3", OP_DREG_OUTPUT, OP_DREG, OP_ACCUM);
2923   tmp = SEXT40 ((GPR (OP[1]) << 16) | GPR (OP[1] + 1)) - SEXT40 (ACC (OP[2]));
2924   SET_GPR32 (OP[0], tmp);
2925   trace_output_32 (tmp);
2926 }
2927
2928 /* subac3 */
2929 void
2930 OP_17000002 ()
2931 {
2932   int64 tmp;
2933
2934   trace_input ("subac3", OP_DREG_OUTPUT, OP_ACCUM, OP_ACCUM);
2935   tmp = SEXT40 (ACC (OP[1])) - SEXT40(ACC (OP[2]));
2936   SET_GPR32 (OP[0], tmp);
2937   trace_output_32 (tmp);
2938 }
2939
2940 /* subac3s */
2941 void
2942 OP_17001000 ()
2943 {
2944   int64 tmp;
2945
2946   trace_input ("subac3s", OP_DREG_OUTPUT, OP_DREG, OP_ACCUM);
2947   SET_PSW_F1 (PSW_F0);
2948   tmp = SEXT40 ((GPR (OP[1]) << 16) | GPR (OP[1] + 1)) - SEXT40(ACC (OP[2]));
2949   if (tmp > SEXT40(MAX32))
2950     {
2951       tmp = (MAX32);
2952       SET_PSW_F0 (1);
2953     }
2954   else if (tmp < SEXT40(MIN32))
2955     {
2956       tmp = (MIN32);
2957       SET_PSW_F0 (1);
2958     }
2959   else
2960     {
2961       SET_PSW_F0 (0);
2962     }
2963   SET_GPR32 (OP[0], tmp);
2964   trace_output_32 (tmp);
2965 }
2966
2967 /* subac3s */
2968 void
2969 OP_17001002 ()
2970 {
2971   int64 tmp;
2972
2973   trace_input ("subac3s", OP_DREG_OUTPUT, OP_ACCUM, OP_ACCUM);
2974   SET_PSW_F1 (PSW_F0);
2975   tmp = SEXT40(ACC (OP[1])) - SEXT40(ACC (OP[2]));
2976   if (tmp > SEXT40(MAX32))
2977     {
2978       tmp = (MAX32);
2979       SET_PSW_F0 (1);
2980     }
2981   else if (tmp < SEXT40(MIN32))
2982     {
2983       tmp = (MIN32);
2984       SET_PSW_F0 (1);
2985     }
2986   else
2987     {
2988       SET_PSW_F0 (0);
2989     }
2990   SET_GPR32 (OP[0], tmp);
2991   trace_output_32 (tmp);
2992 }
2993
2994 /* subi */
2995 void
2996 OP_1 ()
2997 {
2998   unsigned tmp;
2999   if (OP[1] == 0)
3000     OP[1] = 16;
3001
3002   trace_input ("subi", OP_REG, OP_CONSTANT16, OP_VOID);
3003   /* see ../common/sim-alu.h for a more extensive discussion on how to
3004      compute the carry/overflow bits. */
3005   /* since OP[1] is never <= 0, -OP[1] == ~OP[1]+1 can never overflow */
3006   tmp = ((unsigned)(unsigned16) GPR (OP[0])
3007          + (unsigned)(unsigned16) ( - OP[1]));
3008   SET_PSW_C (tmp >= (1 << 16));
3009   SET_GPR (OP[0], tmp);
3010   trace_output_16 (tmp);
3011 }
3012
3013 /* trap */
3014 void
3015 OP_5F00 ()
3016 {
3017   trace_input ("trap", OP_CONSTANT4, OP_VOID, OP_VOID);
3018   trace_output_void ();
3019
3020   switch (OP[0])
3021     {
3022     default:
3023 #if (DEBUG & DEBUG_TRAP) == 0
3024       {
3025         uint16 vec = OP[0] + TRAP_VECTOR_START;
3026         SET_BPC (PC + 1);
3027         SET_BPSW (PSW);
3028         SET_PSW (PSW & PSW_SM_BIT);
3029         JMP (vec);
3030         break;
3031       }
3032 #else                   /* if debugging use trap to print registers */
3033       {
3034         int i;
3035         static int first_time = 1;
3036
3037         if (first_time)
3038           {
3039             first_time = 0;
3040             (*d10v_callback->printf_filtered) (d10v_callback, "Trap  #     PC ");
3041             for (i = 0; i < 16; i++)
3042               (*d10v_callback->printf_filtered) (d10v_callback, "  %sr%d", (i > 9) ? "" : " ", i);
3043             (*d10v_callback->printf_filtered) (d10v_callback, "         a0         a1 f0 f1 c\n");
3044           }
3045
3046         (*d10v_callback->printf_filtered) (d10v_callback, "Trap %2d 0x%.4x:", (int)OP[0], (int)PC);
3047
3048         for (i = 0; i < 16; i++)
3049           (*d10v_callback->printf_filtered) (d10v_callback, " %.4x", (int) GPR (i));
3050
3051         for (i = 0; i < 2; i++)
3052           (*d10v_callback->printf_filtered) (d10v_callback, " %.2x%.8lx",
3053                                              ((int)(ACC (i) >> 32) & 0xff),
3054                                              ((unsigned long) ACC (i)) & 0xffffffff);
3055
3056         (*d10v_callback->printf_filtered) (d10v_callback, "  %d  %d %d\n",
3057                                            PSW_F0 != 0, PSW_F1 != 0, PSW_C != 0);
3058         (*d10v_callback->flush_stdout) (d10v_callback);
3059         break;
3060       }
3061 #endif
3062     case 15:                    /* new system call trap */
3063       /* Trap 15 is used for simulating low-level I/O */
3064       {
3065         unsigned32 result = 0;
3066         errno = 0;
3067
3068 /* Registers passed to trap 0 */
3069
3070 #define FUNC   GPR (4)  /* function number */
3071 #define PARM1  GPR (0)  /* optional parm 1 */
3072 #define PARM2  GPR (1)  /* optional parm 2 */
3073 #define PARM3  GPR (2)  /* optional parm 3 */
3074 #define PARM4  GPR (3)  /* optional parm 3 */
3075
3076 /* Registers set by trap 0 */
3077
3078 #define RETVAL(X)   do { result = (X); SET_GPR (0, result); } while (0)
3079 #define RETVAL32(X) do { result = (X); SET_GPR (0, result >> 16); SET_GPR (1, result); } while (0)
3080 #define RETERR(X) SET_GPR (4, (X))              /* return error code */
3081
3082 /* Turn a pointer in a register into a pointer into real memory. */
3083
3084 #define MEMPTR(x) ((char *)(dmem_addr(x)))
3085
3086         switch (FUNC)
3087           {
3088 #if !defined(__GO32__) && !defined(_WIN32)
3089           case TARGET_SYS_fork:
3090             trace_input ("<fork>", OP_VOID, OP_VOID, OP_VOID);
3091             RETVAL (fork ());
3092             trace_output_16 (result);
3093             break;
3094
3095 #define getpid() 47
3096           case TARGET_SYS_getpid:
3097             trace_input ("<getpid>", OP_VOID, OP_VOID, OP_VOID);
3098             RETVAL (getpid ());
3099             trace_output_16 (result);
3100             break;
3101
3102           case TARGET_SYS_kill:
3103             trace_input ("<kill>", OP_R0, OP_R1, OP_VOID);
3104             if (PARM1 == getpid ())
3105               {
3106                 trace_output_void ();
3107                 State.exception = PARM2;
3108               }
3109             else
3110               {
3111                 int os_sig = -1;
3112                 switch (PARM2)
3113                   {
3114 #ifdef SIGHUP
3115                   case 1: os_sig = SIGHUP;      break;
3116 #endif
3117 #ifdef SIGINT
3118                   case 2: os_sig = SIGINT;      break;
3119 #endif
3120 #ifdef SIGQUIT
3121                   case 3: os_sig = SIGQUIT;     break;
3122 #endif
3123 #ifdef SIGILL
3124                   case 4: os_sig = SIGILL;      break;
3125 #endif
3126 #ifdef SIGTRAP
3127                   case 5: os_sig = SIGTRAP;     break;
3128 #endif
3129 #ifdef SIGABRT
3130                   case 6: os_sig = SIGABRT;     break;
3131 #elif defined(SIGIOT)
3132                   case 6: os_sig = SIGIOT;      break;
3133 #endif
3134 #ifdef SIGEMT
3135                   case 7: os_sig = SIGEMT;      break;
3136 #endif
3137 #ifdef SIGFPE
3138                   case 8: os_sig = SIGFPE;      break;
3139 #endif
3140 #ifdef SIGKILL
3141                   case 9: os_sig = SIGKILL;     break;
3142 #endif
3143 #ifdef SIGBUS
3144                   case 10: os_sig = SIGBUS;     break;
3145 #endif
3146 #ifdef SIGSEGV
3147                   case 11: os_sig = SIGSEGV;    break;
3148 #endif
3149 #ifdef SIGSYS
3150                   case 12: os_sig = SIGSYS;     break;
3151 #endif
3152 #ifdef SIGPIPE
3153                   case 13: os_sig = SIGPIPE;    break;
3154 #endif
3155 #ifdef SIGALRM
3156                   case 14: os_sig = SIGALRM;    break;
3157 #endif
3158 #ifdef SIGTERM
3159                   case 15: os_sig = SIGTERM;    break;
3160 #endif
3161 #ifdef SIGURG
3162                   case 16: os_sig = SIGURG;     break;
3163 #endif
3164 #ifdef SIGSTOP
3165                   case 17: os_sig = SIGSTOP;    break;
3166 #endif
3167 #ifdef SIGTSTP
3168                   case 18: os_sig = SIGTSTP;    break;
3169 #endif
3170 #ifdef SIGCONT
3171                   case 19: os_sig = SIGCONT;    break;
3172 #endif
3173 #ifdef SIGCHLD
3174                   case 20: os_sig = SIGCHLD;    break;
3175 #elif defined(SIGCLD)
3176                   case 20: os_sig = SIGCLD;     break;
3177 #endif
3178 #ifdef SIGTTIN
3179                   case 21: os_sig = SIGTTIN;    break;
3180 #endif
3181 #ifdef SIGTTOU
3182                   case 22: os_sig = SIGTTOU;    break;
3183 #endif
3184 #ifdef SIGIO
3185                   case 23: os_sig = SIGIO;      break;
3186 #elif defined (SIGPOLL)
3187                   case 23: os_sig = SIGPOLL;    break;
3188 #endif
3189 #ifdef SIGXCPU
3190                   case 24: os_sig = SIGXCPU;    break;
3191 #endif
3192 #ifdef SIGXFSZ
3193                   case 25: os_sig = SIGXFSZ;    break;
3194 #endif
3195 #ifdef SIGVTALRM
3196                   case 26: os_sig = SIGVTALRM;  break;
3197 #endif
3198 #ifdef SIGPROF
3199                   case 27: os_sig = SIGPROF;    break;
3200 #endif
3201 #ifdef SIGWINCH
3202                   case 28: os_sig = SIGWINCH;   break;
3203 #endif
3204 #ifdef SIGLOST
3205                   case 29: os_sig = SIGLOST;    break;
3206 #endif
3207 #ifdef SIGUSR1
3208                   case 30: os_sig = SIGUSR1;    break;
3209 #endif
3210 #ifdef SIGUSR2
3211                   case 31: os_sig = SIGUSR2;    break;
3212 #endif
3213                   }
3214
3215                 if (os_sig == -1)
3216                   {
3217                     trace_output_void ();
3218                     (*d10v_callback->printf_filtered) (d10v_callback, "Unknown signal %d\n", PARM2);
3219                     (*d10v_callback->flush_stdout) (d10v_callback);
3220                     State.exception = SIGILL;
3221                   }
3222                 else
3223                   {
3224                     RETVAL (kill (PARM1, PARM2));
3225                     trace_output_16 (result);
3226                   }
3227               }
3228             break;
3229
3230           case TARGET_SYS_execve:
3231             trace_input ("<execve>", OP_R0, OP_R1, OP_R2);
3232             RETVAL (execve (MEMPTR (PARM1), (char **) MEMPTR (PARM2),
3233                              (char **)MEMPTR (PARM3)));
3234             trace_output_16 (result);
3235             break;
3236
3237 #ifdef TARGET_SYS_execv
3238           case TARGET_SYS_execv:
3239             trace_input ("<execv>", OP_R0, OP_R1, OP_VOID);
3240             RETVAL (execve (MEMPTR (PARM1), (char **) MEMPTR (PARM2), NULL));
3241             trace_output_16 (result);
3242             break;
3243 #endif
3244
3245           case TARGET_SYS_pipe:
3246             {
3247               reg_t buf;
3248               int host_fd[2];
3249
3250               trace_input ("<pipe>", OP_R0, OP_VOID, OP_VOID);
3251               buf = PARM1;
3252               RETVAL (pipe (host_fd));
3253               SW (buf, host_fd[0]);
3254               buf += sizeof(uint16);
3255               SW (buf, host_fd[1]);
3256               trace_output_16 (result);
3257             }
3258           break;
3259
3260 #if 0
3261 #ifdef TARGET_SYS_wait
3262           case TARGET_SYS_wait:
3263             {
3264               int status;
3265               trace_input ("<wait>", OP_R0, OP_VOID, OP_VOID);
3266               RETVAL (wait (&status));
3267               if (PARM1)
3268                 SW (PARM1, status);
3269               trace_output_16 (result);
3270             }
3271           break;
3272 #endif
3273 #endif
3274 #else
3275           case TARGET_SYS_getpid:
3276             trace_input ("<getpid>", OP_VOID, OP_VOID, OP_VOID);
3277             RETVAL (1);
3278             trace_output_16 (result);
3279             break;
3280
3281           case TARGET_SYS_kill:
3282             trace_input ("<kill>", OP_REG, OP_REG, OP_VOID);
3283             trace_output_void ();
3284             State.exception = PARM2;
3285             break;
3286 #endif
3287
3288           case TARGET_SYS_read:
3289             trace_input ("<read>", OP_R0, OP_R1, OP_R2);
3290             RETVAL (d10v_callback->read (d10v_callback, PARM1, MEMPTR (PARM2),
3291                                           PARM3));
3292             trace_output_16 (result);
3293             break;
3294
3295           case TARGET_SYS_write:
3296             trace_input ("<write>", OP_R0, OP_R1, OP_R2);
3297             if (PARM1 == 1)
3298               RETVAL ((int)d10v_callback->write_stdout (d10v_callback,
3299                                                          MEMPTR (PARM2), PARM3));
3300             else
3301               RETVAL ((int)d10v_callback->write (d10v_callback, PARM1,
3302                                                   MEMPTR (PARM2), PARM3));
3303             trace_output_16 (result);
3304             break;
3305
3306           case TARGET_SYS_lseek:
3307             trace_input ("<lseek>", OP_R0, OP_R1, OP_R2);
3308             RETVAL32 (d10v_callback->lseek (d10v_callback, PARM1,
3309                                             ((((unsigned long) PARM2) << 16)
3310                                              || (unsigned long) PARM3),
3311                                             PARM4));
3312             trace_output_32 (result);
3313             break;
3314
3315           case TARGET_SYS_close:
3316             trace_input ("<close>", OP_R0, OP_VOID, OP_VOID);
3317             RETVAL (d10v_callback->close (d10v_callback, PARM1));
3318             trace_output_16 (result);
3319             break;
3320
3321           case TARGET_SYS_open:
3322             trace_input ("<open>", OP_R0, OP_R1, OP_R2);
3323             RETVAL (d10v_callback->open (d10v_callback, MEMPTR (PARM1), PARM2));
3324             trace_output_16 (result);
3325             break;
3326
3327           case TARGET_SYS_exit:
3328             trace_input ("<exit>", OP_R0, OP_VOID, OP_VOID);
3329             State.exception = SIG_D10V_EXIT;
3330             trace_output_void ();
3331             break;
3332
3333 #ifdef TARGET_SYS_stat
3334           case TARGET_SYS_stat:
3335             trace_input ("<stat>", OP_R0, OP_R1, OP_VOID);
3336             /* stat system call */
3337             {
3338               struct stat host_stat;
3339               reg_t buf;
3340
3341               RETVAL (stat (MEMPTR (PARM1), &host_stat));
3342
3343               buf = PARM2;
3344
3345               /* The hard-coded offsets and sizes were determined by using
3346                * the D10V compiler on a test program that used struct stat.
3347                */
3348               SW  (buf,    host_stat.st_dev);
3349               SW  (buf+2,  host_stat.st_ino);
3350               SW  (buf+4,  host_stat.st_mode);
3351               SW  (buf+6,  host_stat.st_nlink);
3352               SW  (buf+8,  host_stat.st_uid);
3353               SW  (buf+10, host_stat.st_gid);
3354               SW  (buf+12, host_stat.st_rdev);
3355               SLW (buf+16, host_stat.st_size);
3356               SLW (buf+20, host_stat.st_atime);
3357               SLW (buf+28, host_stat.st_mtime);
3358               SLW (buf+36, host_stat.st_ctime);
3359             }
3360             trace_output_16 (result);
3361             break;
3362 #endif
3363
3364           case TARGET_SYS_chown:
3365             trace_input ("<chown>", OP_R0, OP_R1, OP_R2);
3366             RETVAL (chown (MEMPTR (PARM1), PARM2, PARM3));
3367             trace_output_16 (result);
3368             break;
3369
3370           case TARGET_SYS_chmod:
3371             trace_input ("<chmod>", OP_R0, OP_R1, OP_R2);
3372             RETVAL (chmod (MEMPTR (PARM1), PARM2));
3373             trace_output_16 (result);
3374             break;
3375
3376 #if 0
3377 #ifdef TARGET_SYS_utime
3378           case TARGET_SYS_utime:
3379             trace_input ("<utime>", OP_R0, OP_R1, OP_R2);
3380             /* Cast the second argument to void *, to avoid type mismatch
3381                if a prototype is present.  */
3382             RETVAL (utime (MEMPTR (PARM1), (void *) MEMPTR (PARM2)));
3383             trace_output_16 (result);
3384             break;
3385 #endif
3386 #endif
3387
3388 #if 0
3389 #ifdef TARGET_SYS_time
3390           case TARGET_SYS_time:
3391             trace_input ("<time>", OP_R0, OP_R1, OP_R2);
3392             RETVAL32 (time (PARM1 ? MEMPTR (PARM1) : NULL));
3393             trace_output_32 (result);
3394             break;
3395 #endif
3396 #endif
3397
3398           default:
3399             d10v_callback->error (d10v_callback, "Unknown syscall %d", FUNC);
3400           }
3401         if ((uint16) result == (uint16) -1)
3402           RETERR (d10v_callback->get_errno(d10v_callback));
3403         else
3404           RETERR (0);
3405         break;
3406       }
3407     }
3408 }
3409
3410 /* tst0i */
3411 void
3412 OP_7000000 ()
3413 {
3414   trace_input ("tst0i", OP_REG, OP_CONSTANT16, OP_VOID);
3415   SET_PSW_F1 (PSW_F0);;
3416   SET_PSW_F0 ((GPR (OP[0]) & OP[1]) ? 1 : 0);
3417   trace_output_flag ();
3418 }
3419
3420 /* tst1i */
3421 void
3422 OP_F000000 ()
3423 {
3424   trace_input ("tst1i", OP_REG, OP_CONSTANT16, OP_VOID);
3425   SET_PSW_F1 (PSW_F0);
3426   SET_PSW_F0 ((~(GPR (OP[0])) & OP[1]) ? 1 : 0);
3427   trace_output_flag ();
3428 }
3429
3430 /* wait */
3431 void
3432 OP_5F80 ()
3433 {
3434   trace_input ("wait", OP_VOID, OP_VOID, OP_VOID);
3435   SET_PSW_IE (1);
3436   trace_output_void ();
3437 }
3438
3439 /* xor */
3440 void
3441 OP_A00 ()
3442 {
3443   int16 tmp;
3444   trace_input ("xor", OP_REG, OP_REG, OP_VOID);
3445   tmp = (GPR (OP[0]) ^ GPR (OP[1]));
3446   SET_GPR (OP[0], tmp);
3447   trace_output_16 (tmp);
3448 }
3449
3450 /* xor3 */
3451 void
3452 OP_5000000 ()
3453 {
3454   int16 tmp;
3455   trace_input ("xor3", OP_REG_OUTPUT, OP_REG, OP_CONSTANT16);
3456   tmp = (GPR (OP[1]) ^ OP[2]);
3457   SET_GPR (OP[0], tmp);
3458   trace_output_16 (tmp);
3459 }