#include <signal.h>
#include "d10v_sim.h"
#include "simops.h"

/* #define DEBUG 1 */

/* abs */
void
OP_4607 ()
{
#ifdef DEBUG
  printf("   abs\tr%d\n",OP[0]);
#endif
  State.F1 = State.F0;
  if ((int16)(State.regs[OP[0]]) < 0)
    {
      State.regs[OP[0]] = -(int16)(State.regs[OP[0]]);
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}

/* abs */
void
OP_5607 ()
{
  int64 tmp;

#ifdef DEBUG
  printf("   abs\ta%d\n",OP[0]);
#endif
  State.F1 = State.F0;
  State.a[OP[0]] = SEXT40(State.a[OP[0]]);

  if (State.a[OP[0]] < 0 )
    {
      tmp = -State.a[OP[0]];
      if (State.ST)
	{
	  if (tmp > MAX32)
	    State.a[OP[0]] = MAX32;
	  else if (tmp < MIN32)
	    State.a[OP[0]] = MIN32;
	  else
	    State.a[OP[0]] = tmp & MASK40;
	}
      else
	State.a[OP[0]] = tmp & MASK40;
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}

/* add */
void
OP_200 ()
{
  uint16 tmp = State.regs[OP[0]];
#ifdef DEBUG 
  printf("   add\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] += State.regs[OP[1]];
  if ( tmp > State.regs[OP[0]])
    State.C = 1;
  else
    State.C = 0;
}

/* add */
void
OP_1201 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   add\ta%d,r%d\n",OP[0],OP[1]);
#endif
  tmp = SEXT40(State.a[OP[0]]) + (SEXT16 (State.regs[OP[1]]) << 16 | State.regs[OP[1]+1]);
  if (State.ST)
    {
      if ( tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if ( tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* add */
void
OP_1203 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   add\ta%d,a%d\n",OP[0],OP[1]);
#endif
  tmp = SEXT40(State.a[OP[0]]) + SEXT40(State.a[OP[1]]);
  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if ( tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* add2w */
void
OP_1200 ()
{
  uint32 tmp;
  uint32 tmp1 = (State.regs[OP[0]]) << 16 | State.regs[OP[0]+1];
  uint32 tmp2 = (State.regs[OP[1]]) << 16 | State.regs[OP[1]+1];
#ifdef DEBUG 
  printf("   add2w\tr%d,r%d\n",OP[0],OP[1]);
#endif
  tmp = tmp1 + tmp2;
  if ( (tmp < tmp1) || (tmp < tmp2) )
    State.C = 1;
  else
    State.C = 0;
  State.regs[OP[0]] = tmp >> 16;
  State.regs[OP[0]+1] = tmp & 0xFFFF;
}

/* add3 */
void
OP_1000000 ()
{
  uint16 tmp = State.regs[OP[0]];
#ifdef DEBUG
  printf("   add3\tr%d,r%d,0x%x\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]] + OP[2];
  if ( tmp > State.regs[OP[0]])
    State.C = 1;
  else
    State.C = 0;
}

/* addac3 */
void
OP_17000200 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   addac3\tr%d,r%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40(State.a[OP[2]]) + SEXT40 ((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]);
  State.regs[OP[0]] = (tmp >> 16) & 0xffff;
  State.regs[OP[0]+1] = tmp & 0xffff;
}

/* addac3 */
void
OP_17000202 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   addac3\tr%d,a%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40(State.a[OP[1]]) + SEXT40(State.a[OP[2]]);
  State.regs[OP[0]] = (tmp >> 16) & 0xffff;
  State.regs[OP[0]+1] = tmp & 0xffff;
}

/* addac3s */
void
OP_17001200 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   addac3s\tr%d,r%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  State.F1 = State.F0;
  tmp = SEXT40(State.a[OP[2]]) + SEXT40 ((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]);
  if ( tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.regs[OP[0]+1] = 0xffff;
      State.F0 = 1;
    }      
  else if (tmp < MIN32)
    {
      State.regs[OP[0]] = 0x8000;
      State.regs[OP[0]+1] = 0;
      State.F0 = 1;
    }      
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.regs[OP[0]+1] = tmp & 0xffff;
      State.F0 = 0;
    }      
}

/* addac3s */
void
OP_17001202 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   addac3s\tr%d,a%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  State.F1 = State.F0;
  tmp = SEXT40(State.a[OP[1]]) + SEXT40(State.a[OP[2]]);
  if ( tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.regs[OP[0]+1] = 0xffff;
      State.F0 = 1;
    }      
  else if (tmp < MIN32)
    {
      State.regs[OP[0]] = 0x8000;
      State.regs[OP[0]+1] = 0;
      State.F0 = 1;
    }      
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.regs[OP[0]+1] = tmp & 0xffff;
      State.F0 = 0;
    }      
}

/* addi */
void
OP_201 ()
{
  if (OP[1] == 0)
    OP[1] = 16;
#ifdef DEBUG
  printf("   addi\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] += OP[1];
}

/* and */
void
OP_C00 ()
{
#ifdef DEBUG
  printf("   and\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] &= State.regs[OP[1]];
}

/* and3 */
void
OP_6000000 ()
{
#ifdef DEBUG
  printf("   and3\tr%d,r%d,0x%x\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]] & OP[2];
}

/* bclri */
void
OP_C01 ()
{
#ifdef DEBUG
  printf("   bclri\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] &= ~(0x8000 >> OP[1]);
}

/* bl.s */
void
OP_4900 ()
{
#ifdef DEBUG
  printf("   bl.s\t0x%x\n",OP[0]);
#endif
  State.regs[13] = PC+1;
  PC += SEXT8 (OP[0]);
}

/* bl.l */
void
OP_24800000 ()
{
#ifdef DEBUG
  printf("   bl.l\t0x%x\n",OP[0]);
#endif
  State.regs[13] = PC+1;
  PC += OP[0];
}

/* bnoti */
void
OP_A01 ()
{
#ifdef DEBUG
  printf("   bnoti\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] ^= 0x8000 >> OP[1];
}

/* bra.s */
void
OP_4800 ()
{
#ifdef DEBUG
  printf("   bra.s\t0x%x\n",OP[0]);
#endif
  PC += SEXT8 (OP[0]);
}

/* bra.l */
void
OP_24000000 ()
{
#ifdef DEBUG
  printf("   bra.l\t0x%x\n",OP[0]);
#endif
  PC += OP[0];
}

/* brf0f.s */
void
OP_4A00 ()
{
#ifdef DEBUG
  printf("   brf0f.s\t0x%x\n",OP[0]);
#endif
  if (State.F0 == 0)
    PC += SEXT8 (OP[0]);
}

/* brf0f.l */
void
OP_25000000 ()
{
#ifdef DEBUG
  printf("   brf0f.l\t0x%x\n",OP[0]);
#endif
  if (State.F0 == 0)
    PC += OP[0];
}

/* brf0t.s */
void
OP_4B00 ()
{
#ifdef DEBUG
  printf("   brf0t.s\t0x%x\n",OP[0]);
#endif
  if (State.F0)
    PC += SEXT8 (OP[0]);
}

/* brf0t.l */
void
OP_25800000 ()
{
#ifdef DEBUG
  printf("   brf0t.l\t0x%x\n",OP[0]);
#endif
  if (State.F0)
    PC += OP[0];
}

/* bseti */
void
OP_801 ()
{
#ifdef DEBUG
  printf("   bseti\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] |= 0x8000 >> OP[1];
}

/* btsti */
void
OP_E01 ()
{
#ifdef DEBUG
  printf("   btsti\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] & (0x8000 >> OP[1])) ? 1 : 0;
}

/* clrac */
void
OP_5601 ()
{
#ifdef DEBUG
  printf("   clrac\ta%d\n",OP[0]);
#endif
  State.a[OP[0]] = 0;
}

/* cmp */
void
OP_600 ()
{
#ifdef DEBUG
  printf("   cmp\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = ((int16)(State.regs[OP[0]]) < (int16)(State.regs[OP[1]])) ? 1 : 0;  
}

/* cmp */
void
OP_1603 ()
{
#ifdef DEBUG
  printf("   cmp\ta%d,a%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (SEXT40(State.a[OP[0]]) < SEXT40(State.a[OP[1]])) ? 1 : 0;
}

/* cmpeq */
void
OP_400 ()
{
#ifdef DEBUG
  printf("   cmpeq\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] == State.regs[OP[1]]) ? 1 : 0;  
}

/* cmpeq */
void
OP_1403 ()
{
#ifdef DEBUG
  printf("   cmpeq\ta%d,a%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.a[OP[0]] == State.a[OP[1]]) ? 1 : 0;
}

/* cmpeqi.s */
void
OP_401 ()
{
#ifdef DEBUG
  printf("   cmpeqi.s\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] == SEXT4(OP[1])) ? 1 : 0;  
}

/* cmpeqi.l */
void
OP_2000000 ()
{
#ifdef DEBUG
  printf("   cmpeqi.l\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] == OP[1]) ? 1 : 0;  
}

/* cmpi.s */
void
OP_601 ()
{
#ifdef DEBUG
  printf("   cmpi.s\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = ((int16)(State.regs[OP[0]]) < SEXT4(OP[1])) ? 1 : 0;  
}

/* cmpi.l */
void
OP_3000000 ()
{
#ifdef DEBUG
  printf("   cmpi.l\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = ((int16)(State.regs[OP[0]]) < (int16)(OP[1])) ? 1 : 0;  
}

/* cmpu */
void
OP_4600 ()
{
#ifdef DEBUG
  printf("   cmpu\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] < State.regs[OP[1]]) ? 1 : 0;  
}

/* cmpui */
void
OP_23000000 ()
{
#ifdef DEBUG
  printf("   cmpui\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] < OP[1]) ? 1 : 0;  
}

/* cpfg */
void
OP_4E09 ()
{
  uint8 *src, *dst;
#ifdef DEBUG
  printf("   cpfg\t%x,%x\n",OP[0],OP[1]);
#endif
  
  if (OP[0] == 0)
    dst = &State.F0;
  else
    dst = &State.F1;
  
  if (OP[1] == 0)
    src = &State.F0;
  else if (OP[1] == 1)
    src = &State.F1;
  else
    src = &State.C;

  *dst = *src;
}

/* dbt */
void
OP_5F20 ()
{
  printf("***** DBT *****  PC=%x\n",PC);
  State.exception = SIGTRAP;
}

/* divs */
void
OP_14002800 ()
{
  uint16 foo, tmp, tmpf;
#ifdef DEBUG
  printf("   divs\tr%d,r%d\n",OP[0],OP[1]);
#endif
  foo = (State.regs[OP[0]] << 1) | (State.regs[OP[0]+1] >> 15);
  tmp = (int16)foo - (int16)(State.regs[OP[1]]);
  tmpf = (foo >= State.regs[OP[1]]) ? 1 : 0;
  State.regs[OP[0]] = (tmpf == 1) ? tmp : foo;
  State.regs[OP[0]+1] = (State.regs[OP[0]+1] << 1) | tmpf;
}

/* exef0f */
void
OP_4E04 ()
{
#ifdef DEBUG
  printf("   exef0f\n");
#endif
  State.exe = (State.F0) ? 0 : 1;
}

/* exef0t */
void
OP_4E24 ()
{
#ifdef DEBUG
  printf("   exef0t\n");
#endif
  State.exe = State.F0;
}

/* exef1f */
void
OP_4E40 ()
{
#ifdef DEBUG
  printf("   exef1f\n");
#endif
  State.exe = (State.F1) ? 0 : 1;
}

/* exef1t */
void
OP_4E42 ()
{
#ifdef DEBUG
  printf("   exef1t\n");
#endif
  State.exe = State.F1;
}

/* exefaf */
void
OP_4E00 ()
{
#ifdef DEBUG
  printf("   exefaf\n");
#endif
  State.exe = (State.F0 | State.F1) ? 0 : 1;
}

/* exefat */
void
OP_4E02 ()
{
#ifdef DEBUG
  printf("   exefat\n");
#endif
  State.exe = (State.F0) ? 0 : (State.F1); 
}

/* exetaf */
void
OP_4E20 ()
{
#ifdef DEBUG
  printf("   exetaf\n");
#endif
  State.exe = (State.F1) ? 0 : (State.F0);
}

/* exetat */
void
OP_4E22 ()
{
#ifdef DEBUG
  printf("   exetat\n");
#endif
  State.exe = (State.F0) ? (State.F1) : 0;
}

/* exp */
void
OP_15002A00 ()
{
  uint32 tmp, foo;
  int i;

#ifdef DEBUG
  printf("   exp\tr%d,r%d\n",OP[0],OP[1]);
#endif
  if (((int16)State.regs[OP[1]]) >= 0)
    tmp = (State.regs[OP[1]] << 16) | State.regs[OP[1]+1];
  else
    tmp = ~((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]);
  
  foo = 0x40000000;
  for (i=1;i<17;i++)
    {
      if (tmp & foo)
	{
	  State.regs[OP[0]] = i-1;
	  return;
	}
      foo >>= 1;
    }
  State.regs[OP[0]] = 16;
}

/* exp */
void
OP_15002A02 ()
{
  int64 tmp, foo;
  int i;
#ifdef DEBUG
  printf("   exp\tr%d,a%d\n",OP[0],OP[1]);
#endif
  if (SEXT40(State.a[OP[1]]) >= 0)
    tmp = State.a[OP[1]];
  else
    tmp = ~(State.a[OP[1]]);
  
  foo = 0x4000000000LL;
  for (i=1;i<25;i++)
    {
      if (tmp & foo)
	{
	  State.regs[OP[0]] = i-9;
	  return;
	}
      foo >>= 1;
    }
  State.regs[OP[0]] = 16;
}

/* jl */
void
OP_4D00 ()
{
#ifdef DEBUG
  printf("   jl\t%x\n",OP[0]);
#endif
  State.regs[13] = PC+1;
  PC = State.regs[OP[0]]; 
}

/* jmp */
void
OP_4C00 ()
{
#ifdef DEBUG
  printf("   jmp\tr%d\n",OP[0]);
#endif
  PC = State.regs[OP[0]]; 
}

/* ld */
void
OP_30000000 ()
{
#ifdef DEBUG
  printf("   ld\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = RW (OP[1] + State.regs[OP[2]]);
}

/* ld */
void
OP_6401 ()
{
#ifdef DEBUG
  printf("   ld\tr%d,@r%d-\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
  INC_ADDR(State.regs[OP[1]],-2);
}

/* ld */
void
OP_6001 ()
{
#ifdef DEBUG
  printf("   ld\tr%d,@r%d+\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
  INC_ADDR(State.regs[OP[1]],2);
}

/* ld */
void
OP_6000 ()
{
#ifdef DEBUG
  printf("   ld\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
}

/* ld2w */
void
OP_31000000 ()
{
#ifdef DEBUG
  printf("   ld2w\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = RW (OP[1] + State.regs[OP[2]]);
  State.regs[OP[0]+1] = RW (OP[1] + State.regs[OP[2]] + 2);
}

/* ld2w */
void
OP_6601 ()
{
#ifdef DEBUG
  printf("   ld2w\tr%d,@r%d-\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
  State.regs[OP[0]+1] = RW (State.regs[OP[1]]+2);
  INC_ADDR(State.regs[OP[1]],-4);
}

/* ld2w */
void
OP_6201 ()
{
#ifdef DEBUG
  printf("   ld2w\tr%d,@r%d+\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
  State.regs[OP[0]+1] = RW (State.regs[OP[1]]+2);
  INC_ADDR(State.regs[OP[1]],4);
}

/* ld2w */
void
OP_6200 ()
{
#ifdef DEBUG
  printf("   ld2w\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RW (State.regs[OP[1]]);
  State.regs[OP[0]+1] = RW (State.regs[OP[1]]+2);
}

/* ldb */
void
OP_38000000 ()
{
#ifdef DEBUG
  printf("   ldb\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = RB (OP[1] + State.regs[OP[2]]);
  SEXT8 (State.regs[OP[0]]);
}

/* ldb */
void
OP_7000 ()
{
#ifdef DEBUG
  printf("   ldb\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RB (State.regs[OP[1]]);
  SEXT8 (State.regs[OP[0]]);
}

/* ldi.s */
void
OP_4001 ()
{
#ifdef DEBUG
  printf("   ldi.s\tr%d,%x\n",OP[0],SEXT4(OP[1]));
#endif
  State.regs[OP[0]] = SEXT4(OP[1]);
}

/* ldi.l */
void
OP_20000000 ()
{
#ifdef DEBUG
  printf("   ldi.l\tr%d,%d\t;0x%x\n",OP[0],OP[1],OP[1]);
#endif
  State.regs[OP[0]] = OP[1];
}

/* ldub */
void
OP_39000000 ()
{
#ifdef DEBUG
  printf("   ldub\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = RB (OP[1] + State.regs[OP[2]]);
}

/* ldub */
void
OP_7200 ()
{
#ifdef DEBUG
  printf("   ldub\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = RB (State.regs[OP[1]]);
}

/* mac */
void
OP_2A00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   mac\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)(State.regs[OP[1]]) * (int16)(State.regs[OP[2]]));

  if (State.FX)
    tmp = SEXT40( (tmp << 1) & MASK40);

  if (State.ST && tmp > MAX32)
    tmp = MAX32;

  tmp += SEXT40(State.a[OP[0]]);
  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* macsu */
void
OP_1A00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   macsu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)State.regs[OP[1]] * State.regs[OP[2]]);
  if (State.FX)
    tmp = SEXT40( (tmp << 1) & MASK40);

  State.a[OP[0]] = (SEXT40 (State.a[OP[0]]) + tmp) & MASK40;
}

/* macu */
void
OP_3A00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   macu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 (State.regs[OP[1]] * State.regs[OP[2]]);
  if (State.FX)
    tmp = SEXT40( (tmp << 1) & MASK40);
  State.a[OP[0]] = (SEXT40 (State.a[OP[0]]) + tmp) & MASK40;
}

/* max */
void
OP_2600 ()
{
#ifdef DEBUG
  printf("   max\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  if (State.regs[OP[1]] > State.regs[OP[0]])
    {
      State.regs[OP[0]] = State.regs[OP[1]];
      State.F0 = 1;
    }
  else
    State.F0 = 0;    
}

/* max */
void
OP_3600 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   max\ta%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  tmp = SEXT16 (State.regs[OP[1]]) << 16 | State.regs[OP[1]+1];
  if (tmp > SEXT40(State.a[OP[0]]))
    {
      State.a[OP[0]] = tmp & MASK40;
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}

/* max */
void
OP_3602 ()
{
#ifdef DEBUG
  printf("   max\ta%d,a%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  if (SEXT40(State.a[OP[1]]) > SEXT40(State.a[OP[0]]))
    {
      State.a[OP[0]] = State.a[OP[1]];
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}


/* min */
void
OP_2601 ()
{
#ifdef DEBUG
  printf("   min\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  if (State.regs[OP[1]] < State.regs[OP[0]])
    {
      State.regs[OP[0]] = State.regs[OP[1]];
      State.F0 = 1;
    }
  else
    State.F0 = 0;    
}

/* min */
void
OP_3601 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   min\ta%d,r%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  tmp = SEXT16 (State.regs[OP[1]]) << 16 | State.regs[OP[1]+1];
  if (tmp < SEXT40(State.a[OP[0]]))
    {
      State.a[OP[0]] = tmp & MASK40;
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}

/* min */
void
OP_3603 ()
{
#ifdef DEBUG
  printf("   min\ta%d,a%d\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  if (SEXT40(State.a[OP[1]]) < SEXT40(State.a[OP[0]]))
    {
      State.a[OP[0]] = State.a[OP[1]];
      State.F0 = 1;
    }
  else
    State.F0 = 0;
}

/* msb */
void
OP_2800 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   msb\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)(State.regs[OP[1]]) * (int16)(State.regs[OP[2]]));

  if (State.FX)
    tmp = SEXT40 ((tmp << 1) & MASK40);

  if (State.ST && tmp > MAX32)
    tmp = MAX32;

  tmp = SEXT40(State.a[OP[0]]) - tmp;
  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* msbsu */
void
OP_1800 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   msbsu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)State.regs[OP[1]] * State.regs[OP[2]]);
  if (State.FX)
    tmp = SEXT40( (tmp << 1) & MASK40);

  State.a[OP[0]] = (SEXT40 (State.a[OP[0]]) - tmp) & MASK40;
}

/* msbu */
void
OP_3800 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   msbu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 (State.regs[OP[1]] * State.regs[OP[2]]);
  if (State.FX)
    tmp = SEXT40( (tmp << 1) & MASK40);

  State.a[OP[0]] = (SEXT40 (State.a[OP[0]]) - tmp) & MASK40;
}

/* mul */
void
OP_2E00 ()
{
#ifdef DEBUG
  printf("   mul\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] *= State.regs[OP[1]];
}

/* mulx */
void
OP_2C00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   mulx\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)(State.regs[OP[1]]) * (int16)(State.regs[OP[2]]));

  if (State.FX)
    tmp = SEXT40 ((tmp << 1) & MASK40);

  if (State.ST && tmp > MAX32)
    State.a[OP[0]] = MAX32;
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* mulxsu */
void
OP_1C00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   mulxsu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 ((int16)(State.regs[OP[1]]) * State.regs[OP[2]]);

  if (State.FX)
    tmp <<= 1;

  State.a[OP[0]] = tmp & MASK40;
}

/* mulxu */
void
OP_3C00 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   mulxu\ta%d,r%d,r%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40 (State.regs[OP[1]] * State.regs[OP[2]]);

  if (State.FX)
    tmp <<= 1;

  State.a[OP[0]] = tmp & MASK40;
}

/* mv */
void
OP_4000 ()
{
#ifdef DEBUG
  printf("   mv\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]];
}

/* mv2w */
void
OP_5000 ()
{
#ifdef DEBUG
  printf("   mv2w\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]];
  State.regs[OP[0]+1] = State.regs[OP[1]+1];
}

/* mv2wfac */
void
OP_3E00 ()
{
#ifdef DEBUG
  printf("   mv2wfac\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = (State.a[OP[1]] >> 16) & 0xffff;
  State.regs[OP[0]+1] = State.a[OP[1]] & 0xffff;
}

/* mv2wtac */
void
OP_3E01 ()
{
#ifdef DEBUG
  printf("   mv2wtac\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.a[OP[1]] = (SEXT16 (State.regs[OP[0]]) << 16 | State.regs[OP[0]+1]) & MASK40;
}

/* mvac */
void
OP_3E03 ()
{
#ifdef DEBUG
  printf("   mvac\ta%d,a%d\n",OP[0],OP[1]);
#endif
  State.a[OP[0]] = State.a[OP[1]];
}

/* mvb */
void
OP_5400 ()
{
#ifdef DEBUG
  printf("   mvb\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = SEXT8 (State.regs[OP[1]] & 0xff);
}

/* mvf0f */
void
OP_4400 ()
{
#ifdef DEBUG
  printf("   mvf0f\tr%d,r%d\n",OP[0],OP[1]);
#endif
  if (State.F0 == 0)
    State.regs[OP[0]] = State.regs[OP[1]];
}

/* mvf0t */
void
OP_4401 ()
{
#ifdef DEBUG
  printf("   mvf0t\tr%d,r%d\n",OP[0],OP[1]);
#endif
  if (State.F0)
    State.regs[OP[0]] = State.regs[OP[1]];
}

/* mvfacg */
void
OP_1E04 ()
{
#ifdef DEBUG
  printf("   mvfacg\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = (State.a[OP[1]] >> 32) & 0xff;
}

/* mvfachi */
void
OP_1E00 ()
{
#ifdef DEBUG
  printf("   mvfachi\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = (State.a[OP[1]] >> 16) & 0xffff;  
}

/* mvfaclo */
void
OP_1E02 ()
{
#ifdef DEBUG
  printf("   mvfaclo\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = State.a[OP[1]] & 0xffff;
}

/* mvfc */
void
OP_5200 ()
{
#ifdef DEBUG
  printf("   mvfc\tr%d,cr%d\n",OP[0],OP[1]);
#endif
  if (OP[1] == 0)
    {
      /* PSW is treated specially */
      PSW = 0;
      if (State.SM) PSW |= 0x8000;
      if (State.EA) PSW |= 0x2000;
      if (State.DB) PSW |= 0x1000;
      if (State.IE) PSW |= 0x400;
      if (State.RP) PSW |= 0x200;
      if (State.MD) PSW |= 0x100;
      if (State.FX) PSW |= 0x80;
      if (State.ST) PSW |= 0x40;
      if (State.F0) PSW |= 8;
      if (State.F1) PSW |= 4;
      if (State.C) PSW |= 1;
    }
  State.regs[OP[0]] = State.cregs[OP[1]];
}

/* mvtacg */
void
OP_1E41 ()
{
#ifdef DEBUG
  printf("   mvtacg\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.a[OP[1]] &= MASK32;
  State.a[OP[1]] |= (int64)(State.regs[OP[0]] & 0xff) << 32;
}

/* mvtachi */
void
OP_1E01 ()
{
  uint16 tmp;
#ifdef DEBUG
  printf("   mvtachi\tr%d,a%d\n",OP[0],OP[1]);
#endif
  tmp = State.a[OP[1]] & 0xffff;
  State.a[OP[1]] = (SEXT16 (State.regs[OP[0]]) << 16 | tmp) & MASK40;
}

/* mvtaclo */
void
OP_1E21 ()
{
#ifdef DEBUG
  printf("   mvtaclo\tr%d,a%d\n",OP[0],OP[1]);
#endif
  State.a[OP[1]] = (SEXT16 (State.regs[OP[0]])) & MASK40;
}

/* mvtc */
void
OP_5600 ()
{
#ifdef DEBUG
  printf("   mvtc\tr%d,cr%d\n",OP[0],OP[1]);
#endif
  State.cregs[OP[1]] =  State.regs[OP[0]];
  if (OP[1] == 0)
    {
      /* PSW is treated specially */
      State.SM = (PSW & 0x8000) ? 1 : 0;
      State.EA = (PSW & 0x2000) ? 1 : 0;
      State.DB = (PSW & 0x1000) ? 1 : 0;
      State.IE = (PSW & 0x400) ? 1 : 0;
      State.RP = (PSW & 0x200) ? 1 : 0;
      State.MD = (PSW & 0x100) ? 1 : 0;
      State.FX = (PSW & 0x80) ? 1 : 0;
      State.ST = (PSW & 0x40) ? 1 : 0;
      State.F0 = (PSW & 8) ? 1 : 0;
      State.F1 = (PSW & 4) ? 1 : 0;
      State.C = PSW & 1;
      if (State.ST && !State.FX)
	{
	  fprintf (stderr,"ERROR at PC 0x%x: ST can only be set when FX is set.\n",PC<<2);
	  State.exception = SIGILL;
	}
    }
}

/* mvub */
void
OP_5401 ()
{
#ifdef DEBUG
  printf("   mvub\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]] & 0xff;
}

/* neg */
void
OP_4605 ()
{
#ifdef DEBUG
  printf("   neg\tr%d\n",OP[0]);
#endif
  State.regs[OP[0]] = 0 - State.regs[OP[0]];
}

/* neg */
void
OP_5605 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   neg\ta%d\n",OP[0]);
#endif
  tmp = -SEXT40(State.a[OP[0]]);
  if (State.ST)
    {
      if ( tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}


/* nop */
void
OP_5E00 ()
{
}

/* not */
void
OP_4603 ()
{
#ifdef DEBUG
  printf("   not\tr%d\n",OP[0]);
#endif
  State.regs[OP[0]] = ~(State.regs[OP[0]]);  
}

/* or */
void
OP_800 ()
{
#ifdef DEBUG
  printf("   or\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] |= State.regs[OP[1]];
}

/* or3 */
void
OP_4000000 ()
{
#ifdef DEBUG
  printf("   or3\tr%d,r%d,0x%x\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]] | OP[2];
}

/* rac */
void
OP_5201 ()
{
  int64 tmp;
  int shift = SEXT3 (OP[2]);
#ifdef DEBUG
  printf("   rac\tr%d,a%d,%d\n",OP[0],OP[1],shift);
#endif
  State.F1 = State.F0;
  if (shift >=0)
    tmp = ((State.a[0] << 16) | (State.a[1] & 0xffff)) << shift;
  else
    tmp = ((State.a[0] << 16) | (State.a[1] & 0xffff)) >> -shift;
  tmp = (tmp + 0x8000) >> 16;
    
  if (tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.regs[OP[0]+1] = 0xffff;
      State.F0 = 1;
    } 
  else if (tmp < MIN32)
    {
      State.regs[OP[0]] = 0x8000;
      State.regs[OP[0]+1] = 0;
      State.F0 = 1;
    } 
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.regs[OP[0]+1] = tmp & 0xffff;
      State.F0 = 0;
    }
}

/* rachi */
void
OP_4201 ()
{
  int64 tmp;
  int shift = SEXT3 (OP[2]);
#ifdef DEBUG
  printf("   rachi\tr%d,a%d,%d\n",OP[0],OP[1],shift);
#endif
  State.F1 = State.F0;
  if (shift >=0)
    tmp = SEXT40 (State.a[1]) << shift;
  else
    tmp = SEXT40 (State.a[1]) >> -shift;
  tmp += 0x8000;
  if (tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.F0 = 1;
    }
  else if (tmp < 0xfff80000000LL)
    {
      State.regs[OP[0]] = 0x8000;
      State.F0 = 1;
    }
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.F0 = 0;
    }
}

/* rep */
void
OP_27000000 ()
{
#ifdef DEBUG
  printf("   rep\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  RPT_S = PC + 1;
  RPT_E = PC + OP[1];
  RPT_C = State.regs[OP[0]];
  State.RP = 1;
  if (RPT_C == 0)
    {
      fprintf (stderr, "ERROR: rep with count=0 is illegal.\n");
      State.exception = SIGILL;
    }
  if (OP[1] < 4)
    {
      fprintf (stderr, "ERROR: rep must include at least 4 instructions.\n");
      State.exception = SIGILL;
    }
}

/* repi */
void
OP_2F000000 ()
{
#ifdef DEBUG
  printf("   repi\t%d,0x%x\n",OP[0],OP[1]);
#endif
  RPT_S = PC + 1;
  RPT_E = PC + OP[1];
  RPT_C = OP[0];
  State.RP = 1;
  if (RPT_C == 0)
    {
      fprintf (stderr, "ERROR: repi with count=0 is illegal.\n");
      State.exception = SIGILL;
    }
  if (OP[1] < 4)
    {
      fprintf (stderr, "ERROR: repi must include at least 4 instructions.\n");
      State.exception = SIGILL;
    }
}

/* rtd */
void
OP_5F60 ()
{
  printf("   rtd - NOT IMPLEMENTED\n");
}

/* rte */
void
OP_5F40 ()
{
#ifdef DEBUG
  printf("   rte\n");
#endif
  PC = BPC;
  PSW = BPSW;
}

/* sadd */
void
OP_1223 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   sadd\ta%d,a%d\n",OP[0],OP[1]);
#endif
  tmp = SEXT40(State.a[OP[0]]) + (SEXT40(State.a[OP[1]]) >> 16);
  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* setf0f */
void
OP_4611 ()
{
#ifdef DEBUG
  printf("   setf0f\tr%d\n",OP[0]);
#endif
  State.regs[OP[0]] = (State.F0 == 0) ? 1 : 0;
}

/* setf0t */
void
OP_4613 ()
{
#ifdef DEBUG
  printf("   setf0t\tr%d\n",OP[0]);
#endif
  State.regs[OP[0]] = (State.F0 == 1) ? 1 : 0;
}

/* sleep */
void
OP_5FC0 ()
{
#ifdef DEBUG
  printf("   sleep\n");
#endif
  State.IE = 1;
}

/* sll */
void
OP_2200 ()
{
#ifdef DEBUG
  printf("   sll\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] <<= (State.regs[OP[1]] & 0xf);
}

/* sll */
void
OP_3200 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   sll\ta%d,r%d\n",OP[0],OP[1]);
#endif
  if (State.regs[OP[1]] & 31 <= 16)
    tmp = SEXT40 (State.a[OP[0]]) << (State.regs[OP[1]] & 31);

  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < 0xffffff80000000LL)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* slli */
void
OP_2201 ()
{
#ifdef DEBUG
  printf("   slli\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] <<= OP[1];
}

/* slli */
void
OP_3201 ()
{
  int64 tmp;

  if (OP[1] == 0)
    OP[1] = 16;
#ifdef DEBUG
  printf("   slli\ta%d,%d\n",OP[0],OP[1]);
#endif

  tmp = SEXT40(State.a[OP[0]]) << OP[1];

  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if (tmp < 0xffffff80000000LL)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* slx */
void
OP_460B ()
{
  uint16 tmp;
#ifdef DEBUG
  printf("   slx\tr%d\n",OP[0]);
#endif
  State.regs[OP[0]] = (State.regs[OP[0]] << 1) | State.F0;
}

/* sra */
void
OP_2400 ()
{
#ifdef DEBUG
  printf("   sra\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = ((int16)(State.regs[OP[0]])) >> (State.regs[OP[1]] & 0xf);
}

/* sra */
void
OP_3400 ()
{
#ifdef DEBUG
  printf("   sra\ta%d,r%d\n",OP[0],OP[1]);
#endif
  if (State.regs[OP[1]] & 31 <= 16)
    State.a[OP[0]] >>= (State.regs[OP[1]] & 31);
}

/* srai */
void
OP_2401 ()
{
#ifdef DEBUG
  printf("   srai\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] = ((int16)(State.regs[OP[0]])) >> OP[1];
}

/* srai */
void
OP_3401 ()
{
  if (OP[1] == 0)
    OP[1] = 16;
#ifdef DEBUG
  printf("   srai\ta%d,%d\n",OP[0],OP[1]);
#endif
    State.a[OP[0]] >>= OP[1];
}

/* srl */
void
OP_2000 ()
{
#ifdef DEBUG
  printf("   srl\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] >>=  (State.regs[OP[1]] & 0xf);
}

/* srl */
void
OP_3000 ()
{
#ifdef DEBUG
  printf("   srl\ta%d,r%d\n",OP[0],OP[1]);
#endif
  if (State.regs[OP[1]] & 31 <= 16)
    State.a[OP[0]] >>= (State.regs[OP[1]] & 31);
}

/* srli */
void
OP_2001 ()
{
#ifdef DEBUG
printf("   srli\tr%d,%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] >>= OP[1];
}

/* srli */
void
OP_3001 ()
{
  if (OP[1] == 0)
    OP[1] = 16;
#ifdef DEBUG
  printf("   srli\ta%d,%d\n",OP[0],OP[1]);
#endif
    State.a[OP[0]] >>= OP[1];
}

/* srx */
void
OP_4609 ()
{
  uint16 tmp;
#ifdef DEBUG
  printf("   srx\tr%d\n",OP[0]);
#endif
  tmp = State.F0 << 15;
  State.regs[OP[0]] = (State.regs[OP[0]] >> 1) | tmp;
}

/* st */
void
OP_34000000 ()
{
#ifdef DEBUG
  printf("   st\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  SW (OP[1] + State.regs[OP[2]], State.regs[OP[0]]);
}

/* st */
void
OP_6800 ()
{
#ifdef DEBUG
  printf("   st\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]], State.regs[OP[0]]);
}

/* st */
void
OP_6C1F ()
{
#ifdef DEBUG
  printf("   st\tr%d,@-r%d\n",OP[0],OP[1]);
#endif
  if ( OP[1] != 15 )
    {
      fprintf (stderr,"ERROR: cannot pre-decrement any registers but r15 (SP).\n");
      State.exception = SIGILL;
      return;
    }
  State.regs[OP[1]] -= 2;
  SW (State.regs[OP[1]], State.regs[OP[0]]);
}

/* st */
void
OP_6801 ()
{
#ifdef DEBUG
  printf("   st\tr%d,@r%d+\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]], State.regs[OP[0]]);
  INC_ADDR (State.regs[OP[1]],2);
}

/* st */
void
OP_6C01 ()
{
#ifdef DEBUG
  printf("   st\tr%d,@r%d-\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]], State.regs[OP[0]]);
  INC_ADDR (State.regs[OP[1]],-2);
}

/* st2w */
void
OP_35000000 ()
{
#ifdef DEBUG
  printf("   st2w\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  SW (State.regs[OP[2]]+OP[1], State.regs[OP[0]]);
  SW (State.regs[OP[2]]+OP[1]+2, State.regs[OP[0]+1]);
}

/* st2w */
void
OP_6A00 ()
{
#ifdef DEBUG
  printf("   st2w\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]],   State.regs[OP[0]]);
  SW (State.regs[OP[1]]+2, State.regs[OP[0]+1]);
}

/* st2w */
void
OP_6E1F ()
{
#ifdef DEBUG
  printf("   st2w\tr%d,@-r%d\n",OP[0],OP[1]);
#endif
  if ( OP[1] != 15 )
    {
      fprintf (stderr,"ERROR: cannot pre-decrement any registers but r15 (SP).\n");
      State.exception = SIGILL;
      return;
    }
  State.regs[OP[1]] -= 4;
  SW (State.regs[OP[1]],   State.regs[OP[0]]);
  SW (State.regs[OP[1]]+2, State.regs[OP[0]+1]);
}

/* st2w */
void
OP_6A01 ()
{
#ifdef DEBUG
  printf("   st2w\tr%d,r%d+\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]],   State.regs[OP[0]]);
  SW (State.regs[OP[1]]+2, State.regs[OP[0]+1]);
  INC_ADDR (State.regs[OP[1]],4);
}

/* st2w */
void
OP_6E01 ()
{
#ifdef DEBUG
  printf("   st2w\tr%d,r%d-\n",OP[0],OP[1]);
#endif
  SW (State.regs[OP[1]],   State.regs[OP[0]]);
  SW (State.regs[OP[1]]+2, State.regs[OP[0]+1]);
  INC_ADDR (State.regs[OP[1]],-4);
}

/* stb */
void
OP_3C000000 ()
{
#ifdef DEBUG
  printf("   stb\tr%d,@(0x%x,r%d)\n",OP[0],OP[1],OP[2]);
#endif
  SB (State.regs[OP[2]]+OP[1], State.regs[OP[0]]);
}

/* stb */
void
OP_7800 ()
{
#ifdef DEBUG
  printf("   stb\tr%d,@r%d\n",OP[0],OP[1]);
#endif
  SB (State.regs[OP[1]], State.regs[OP[0]]);
}

/* stop */
void
OP_5FE0 ()
{
#ifdef DEBUG
  printf("   stop\n");
#endif
  State.exception = SIGQUIT;
}

/* sub */
void
OP_0 ()
{
  int32 tmp;
#ifdef DEBUG
  printf("   sub\tr%d,r%d\n",OP[0],OP[1]);
#endif
  tmp = (int16)State.regs[OP[0]]- (int16)State.regs[OP[1]];
  State.C = (tmp & 0xffff0000) ? 1 : 0;
  State.regs[OP[0]] = tmp & 0xffff;
}

/* sub */
void
OP_1001 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   sub\ta%d,r%d\n",OP[0],OP[1]);
#endif
  tmp = SEXT40(State.a[OP[0]]) - (SEXT16 (State.regs[OP[1]]) << 16 | State.regs[OP[1]+1]);
  if (State.ST)
    {
      if ( tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if ( tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* sub */

void
OP_1003 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   sub\ta%d,a%d\n",OP[0],OP[1]);
#endif
  tmp = SEXT40(State.a[OP[0]]) - SEXT40(State.a[OP[1]]);
  if (State.ST)
    {
      if (tmp > MAX32)
	State.a[OP[0]] = MAX32;
      else if ( tmp < MIN32)
	State.a[OP[0]] = MIN32;
      else
	State.a[OP[0]] = tmp & MASK40;
    }
  else
    State.a[OP[0]] = tmp & MASK40;
}

/* sub2w */
void
OP_1000 ()
{
  int64 tmp;
  int32 a,b;
#ifdef DEBUG
  printf("   sub2w\tr%d,r%d\n",OP[0],OP[1]);
#endif

  a = (int32)((State.regs[OP[0]] << 16) | State.regs[OP[0]+1]);
  b = (int32)((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]);
  tmp = a-b;
  State.C = (tmp & 0xffffffff00000000LL) ? 1 : 0;  
  State.regs[OP[0]] = (tmp >> 16) & 0xffff;
  State.regs[OP[0]+1] = tmp & 0xffff;
}

/* subac3 */
void
OP_17000000 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   subac3\tr%d,r%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp =  SEXT40 ((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]) - SEXT40 (State.a[OP[2]]);
  State.regs[OP[0]] = (tmp >> 16) & 0xffff;
  State.regs[OP[0]+1] = tmp & 0xffff;
}

/* subac3 */
void
OP_17000002 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   subac3\tr%d,a%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  tmp = SEXT40(State.a[OP[1]]) - SEXT40(State.a[OP[2]]);
  State.regs[OP[0]] = (tmp >> 16) & 0xffff;
  State.regs[OP[0]+1] = tmp & 0xffff;
}

/* subac3s */
void
OP_17001000 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   subac3s\tr%d,r%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  State.F1 = State.F0;
  tmp = SEXT40 ((State.regs[OP[1]] << 16) | State.regs[OP[1]+1]) - SEXT40(State.a[OP[2]]);
  if ( tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.regs[OP[0]+1] = 0xffff;
      State.F0 = 1;
    }      
  else if (tmp < MIN32)
    {
      State.regs[OP[0]] = 0x8000;
      State.regs[OP[0]+1] = 0;
      State.F0 = 1;
    }      
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.regs[OP[0]+1] = tmp & 0xffff;
      State.F0 = 0;
    }      
}

/* subac3s */
void
OP_17001002 ()
{
  int64 tmp;
#ifdef DEBUG
  printf("   subac3s\tr%d,a%d,a%d\n",OP[0],OP[1],OP[2]);
#endif
  State.F1 = State.F0;
  tmp = SEXT40(State.a[OP[1]]) - SEXT40(State.a[OP[2]]);
  if ( tmp > MAX32)
    {
      State.regs[OP[0]] = 0x7fff;
      State.regs[OP[0]+1] = 0xffff;
      State.F0 = 1;
    }      
  else if (tmp < MIN32)
    {
      State.regs[OP[0]] = 0x8000;
      State.regs[OP[0]+1] = 0;
      State.F0 = 1;
    }      
  else
    {
      State.regs[OP[0]] = (tmp >> 16) & 0xffff;
      State.regs[OP[0]+1] = tmp & 0xffff;
      State.F0 = 0;
    }      
}

/* subi */
void
OP_1 ()
{
  int32 tmp;
  if (OP[1] == 0)
    OP[1] = 16;
#ifdef DEBUG
  printf("   subi\tr%d,%d\n",OP[0],OP[1]);
#endif
  tmp = (int16)State.regs[OP[0]] - OP[1];
  State.C = (tmp & 0xffff0000) ? 1 : 0;
  State.regs[OP[0]] = tmp & 0xffff;  
}

/* trap */
void
OP_5F00 ()
{
#ifdef DEBUG
  printf("   trap\t%d\n",OP[0]);
#endif
  
  /* for now, trap  is used for simulating IO */

  if (OP[0] == 0)
    {
      char *fstr = State.regs[2] + State.imem;
      printf (fstr,State.regs[3],State.regs[4],State.regs[5]);
    }
  else if (OP[0] == 1 )
    {
      char *fstr = State.regs[2] + State.imem;
      puts (fstr);
    }
}

/* tst0i */
void
OP_7000000 ()
{
#ifdef DEBUG
  printf("   tst0i\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (State.regs[OP[0]] & OP[1]) ? 1 : 0;
}

/* tst1i */
void
OP_F000000 ()
{
#ifdef DEBUG
  printf("   tst1i\tr%d,0x%x\n",OP[0],OP[1]);
#endif
  State.F1 = State.F0;
  State.F0 = (~(State.regs[OP[0]]) & OP[1]) ? 1 : 0;
}

/* wait */
void
OP_5F80 ()
{
#ifdef DEBUG
  printf("   wait\n");
#endif
  State.IE = 1;
}

/* xor */
void
OP_A00 ()
{
#ifdef DEBUG
  printf("   xor\tr%d,r%d\n",OP[0],OP[1]);
#endif
  State.regs[OP[0]] ^= State.regs[OP[1]];
}

/* xor3 */
void
OP_5000000 ()
{
#ifdef DEBUG
  printf("   xor3\tr%d,r%d,0x%x\n",OP[0],OP[1],OP[2]);
#endif
  State.regs[OP[0]] = State.regs[OP[1]] ^ OP[2];
}