*** empty log message ***
[fw/sdcc] / sim / ucsim / xa.src / inst.cc
index ed6f1f900e059539ed43be033630d3cd98a2c386..ec737aa83bd2d38e10cd059eed8574e881502c4f 100644 (file)
@@ -35,26 +35,87 @@ Software Foundation, 59 Temple Place - Suite 330, Boston, MA
 #include "xacl.h"
 #include "regsxa.h"
 
-int
-cl_xa::get_reg(int word_flag, unsigned int index)
+
+void cl_xa::store1(t_addr addr, unsigned char val)
 {
-  //if (index < 3) { /* banked */
-  //  if (word_flag)
-  //    return get_word_direct(0x400+index);
-  //  else
-  //    return mem_direct[0x400+index];
-  //} else { /* non-banked */
-    if (word_flag)
-      return get_word_direct(0x400+index);
-    else
-      return mem_direct[0x400+index];
-  //}
+  if (addr < 0x2000) {
+    set_idata1(addr, val);
+  } else {
+    set_xdata1(addr, val);
+  }
 }
 
-int
-cl_xa::inst_NOP(uint code, int operands)
+void cl_xa::store2(t_addr addr, unsigned char val)
 {
-  return(resGO);
+  if (addr < 0x2000) {
+    set_idata2(addr, val);
+  } else {
+    set_xdata2(addr, val);
+  }
+}
+
+unsigned char cl_xa::get1(t_addr addr)
+{
+  if (addr < 0x2000) {
+    return get_idata1(addr);
+  } else {
+    return get_xdata1(addr);
+  }
+}
+
+unsigned short cl_xa::get2(t_addr addr)
+{
+  if (addr < 0x2000) {
+    return get_idata2(addr);
+  } else {
+    return get_xdata2(addr);
+  }
+}
+
+int cl_xa::get_reg(int word_flag, unsigned int index)
+{
+  int result;
+
+  if (word_flag) {
+    result = get_word_direct(index);
+  }
+  else {
+    result = get_byte_direct(index);
+  }
+  return result;
+}
+
+bool cl_xa::get_bit(int bit) {
+  short offset=0;
+  unsigned char result;
+
+  if (bit>=0x200) {
+    // in sfr space
+    bit-=0x200;
+    offset=0x400;
+  }
+  result = get_byte_direct(offset + (bit/8)) & (1 << (bit%8));
+  return result;
+  //return mem_direct[offset + (bit/8)] & (1 << (bit%8));
+}
+
+void cl_xa::set_bit(int bit, int value) {
+  int i;
+  short offset=0;
+  if (bit>=0x200) {
+    // in sfr space
+    bit-=0x200;
+    offset=0x400;
+  }
+
+  i = get_byte_direct(offset + (bit/8));
+  if (value) {
+    set_byte_direct(offset + (bit/8), i | (1 << (bit%8)) );
+    //mem_direct[offset + (bit/8)] |= (1 << (bit%8));
+  } else {
+    set_byte_direct(offset + (bit/8), i & ~(1 << (bit%8)) );
+    //mem_direct[offset + (bit/8)] &= ~(1 << (bit%8));
+  }
 }
 
 #define RI_F0 ((code >> 4) & 0xf)
@@ -62,8 +123,7 @@ cl_xa::inst_NOP(uint code, int operands)
 #define RI_0F (code & 0xf)
 #define RI_07 (code & 0x7)
 
-int
-cl_xa::inst_ADD(uint code, int operands)
+int cl_xa::inst_ADD(uint code, int operands)
 {
 #undef FUNC1
 #define FUNC1 add1
@@ -74,8 +134,7 @@ cl_xa::inst_ADD(uint code, int operands)
   return(resGO);
 }
 
-int
-cl_xa::inst_ADDC(uint code, int operands)
+int cl_xa::inst_ADDC(uint code, int operands)
 {
 #undef FUNC1
 #define FUNC1 addc1
@@ -86,40 +145,12 @@ cl_xa::inst_ADDC(uint code, int operands)
   return(resGO);
 }
 
-int
-cl_xa::inst_SUB(uint code, int operands)
-{
-#undef FUNC1
-#define FUNC1 sub1
-#undef FUNC2
-#define FUNC2 sub2
-#include "inst_gen.cc"
-  return(resGO);
-}
-
-int
-cl_xa::inst_SUBB(uint code, int operands)
+int cl_xa::inst_ADDS(uint code, int operands)
 {
-#undef FUNC1
-#define FUNC1 subb1
-#undef FUNC2
-#define FUNC2 subb2
-#include "inst_gen.cc"
   return(resGO);
 }
 
-int
-cl_xa::inst_CMP(uint code, int operands)
-{
-#undef FUNC1
-#define FUNC1 cmp1
-#undef FUNC2
-#define FUNC2 cmp2
-#include "inst_gen.cc"
-  return(resGO);
-}
-int
-cl_xa::inst_AND(uint code, int operands)
+int cl_xa::inst_AND(uint code, int operands)
 {
 #undef FUNC1
 #define FUNC1 and1
@@ -128,354 +159,135 @@ cl_xa::inst_AND(uint code, int operands)
 #include "inst_gen.cc"
   return(resGO);
 }
-int
-cl_xa::inst_OR(uint code, int operands)
-{
-#undef FUNC1
-#define FUNC1 or1
-#undef FUNC2
-#define FUNC2 or2
-#include "inst_gen.cc"
-  return(resGO);
-}
-int
-cl_xa::inst_XOR(uint code, int operands)
-{
-#undef FUNC1
-#define FUNC1 xor1
-#undef FUNC2
-#define FUNC2 xor2
-#include "inst_gen.cc"
-  return(resGO);
-}
-int
-cl_xa::inst_ADDS(uint code, int operands)
+
+int cl_xa::inst_ANL(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_NEG(uint code, int operands)
+
+int cl_xa::inst_ASL(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_SEXT(uint code, int operands)
+
+int cl_xa::inst_ASR(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_MUL(uint code, int operands)
+
+int cl_xa::inst_BCC(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_DIV(uint code, int operands)
+
+int cl_xa::inst_BCS(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_DA(uint code, int operands)
+
+int cl_xa::inst_BEQ(uint code, int operands)
 {
+  short jmpAddr = fetch1()*2;
+  if (get_psw() & BIT_Z) {
+    PC=(PC+jmpAddr)&0xfffffffe;
+  }
   return(resGO);
 }
-int
-cl_xa::inst_ASL(uint code, int operands)
+
+int cl_xa::inst_BG(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_ASR(uint code, int operands)
+int cl_xa::inst_BGE(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_LEA(uint code, int operands)
+int cl_xa::inst_BGT(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_CPL(uint code, int operands)
+int cl_xa::inst_BKPT(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_LSR(uint code, int operands)
+int cl_xa::inst_BL(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_NORM(uint code, int operands)
+int cl_xa::inst_BLE(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_RL(uint code, int operands)
+int cl_xa::inst_BLT(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_RLC(uint code, int operands)
+int cl_xa::inst_BMI(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_RR(uint code, int operands)
+int cl_xa::inst_BNE(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_RRC(uint code, int operands)
+int cl_xa::inst_BNV(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_MOVS(uint code, int operands)
+int cl_xa::inst_BOV(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_MOVC(uint code, int operands)
+int cl_xa::inst_BPL(uint code, int operands)
 {
-  switch (operands) {
-    case REG_IREGINC:
-    {
-      short srcreg = reg2(RI_07);
-      if (code & 0x0800) {  /* word op */
-        set_reg2( RI_F0,
-                  mov2( reg2(RI_F0),
-                        getcode2(srcreg)
-                      )
-                );
-      } else {
-        set_reg1( RI_F0,
-                  mov1( reg1(RI_F0),
-                        getcode1(srcreg)
-                      )
-                );
-      }
-      if (operands == REG_IREGINC) {
-        set_reg2(RI_07,  srcreg+1);
-      }
-    }
-    break;
-    // fixme, 2 more
-  }
-  return(resGO);
-}
-int
-cl_xa::inst_MOVX(uint code, int operands)
-{
-  return(resGO);
-}
-int
-cl_xa::inst_PUSH(uint code, int operands)
-{
-  switch(operands) {
-    case DIRECT_ALONE:
-    {
-      unsigned short sp;
-      unsigned short direct_addr = ((operands & 0x7) << 8) | fetch();
-
-      sp = get_sp()-2;
-      set_sp(sp);
-      if (code & 0x0800) {  /* word op */
-        store2( sp, get_word_direct(direct_addr));
-      } else {
-        store2( sp, get_byte_direct(direct_addr));
-      }
-    }
-    break;
-
-    case RLIST:
-      // fixme: implement
-      unsigned char rlist = fetch();
-      rlist = rlist; //shutup compiler
-    break;
-  }
-  
   return(resGO);
 }
-int
-cl_xa::inst_POP(uint code, int operands)
-{
-  switch(operands) {
-    case DIRECT_ALONE:
-    {
-      unsigned short sp;
-      unsigned short direct_addr = ((operands & 0x7) << 8) | fetch();
-
-      sp = get_sp();
-      if (code & 0x0800) {  /* word op */
-        set_word_direct(direct_addr, get2(sp) );
-      } else {
-        set_byte_direct(direct_addr, get2(sp) & 0xff );
-      }
-      set_sp(sp+2);
-    }
-    break;
 
-    case RLIST:
-      // fixme: implement
-      unsigned char rlist = fetch();
-      rlist = rlist; //shutup compiler
-    break;
-  }
-  return(resGO);
-}
-int
-cl_xa::inst_XCH(uint code, int operands)
-{
-  return(resGO);
-}
-int
-cl_xa::inst_SETB(uint code, int operands)
-{
-  unsigned short bitAddr = (code&0x03 << 8) + fetch();
-  // fixme: implement
-  bitAddr=bitAddr;
-  return(resGO);
-}
-int
-cl_xa::inst_CLR(uint code, int operands)
-{
-  unsigned short bitAddr = (code&0x03 << 8) + fetch();
-  // fixme: implement
-  bitAddr=bitAddr;
-  return(resGO);
-}
-int
-cl_xa::inst_MOV(uint code, int operands)
-{
-#undef FUNC1
-#define FUNC1 mov1
-#undef FUNC2
-#define FUNC2 mov2
-#include "inst_gen.cc"
-  return(resGO);
-}
-int
-cl_xa::inst_ANL(uint code, int operands)
-{
-  return(resGO);
-}
-int
-cl_xa::inst_ORL(uint code, int operands)
-{
-  return(resGO);
-}
-int
-cl_xa::inst_BEQ(uint code, int operands)
-{
-  short jmpAddr = fetch1()*2;
-  if (get_psw() & BIT_Z) {
-    PC=(PC+jmpAddr)&0xfffffffe;
-  }
-  return(resGO);
-}
-int
-cl_xa::inst_BR(uint code, int operands)
+int cl_xa::inst_BR(uint code, int operands)
 {
   short jmpAddr = fetch1()*2;
-  PC=(PC+jmpAddr)&0xfffffffe;
+  PC=(PC+jmpAddr)&0xfffffe;
   return(resGO);
 }
-int
-cl_xa::inst_JMP(uint code, int operands)
-{
-  int jmpAddr;
 
-  switch(operands) {
-    case REL16:
-    {
-      jmpAddr = (signed short)fetch2()*2;
-      PC = (PC + jmpAddr) & 0xfffffffe;
-    }
-    break;
-    case IREG:
-      PC &= 0xff0000;
-      PC |= (reg2(RI_07) & 0xfffe);  /* word aligned */
-    break;
-    /* fixme 2 more... */
-  }
-  return(resGO);
-}
-int
-cl_xa::inst_CALL(uint code, int operands)
+int cl_xa::inst_CALL(uint code, int operands)
 {
   int jmpaddr;
   unsigned int sp;
+  bool pageZero=get_scr()&1;
 
   switch(operands) {
     case REL16:
     {
       jmpaddr = (signed short)fetch2();
-      sp = get_sp() - 4;
+      sp = get_sp() - (pageZero ? 2 : 4);
       set_sp(sp);
-      store2(sp, PC);
-      store2(sp+2, 0);  /* segment(not sure about ordering...) */
+      store2(sp, PC&0xffff);
+      if (!pageZero) {
+       store2(sp+2, (PC>>16)&0xff);
+      }
       jmpaddr *= 2;
-      PC = (PC + jmpaddr) & 0xfffffffe;
+      PC = (PC + jmpaddr) & 0xfffffe;
     }
     break;
     case IREG:
     {
-      sp = get_sp() - 2;
+      sp = get_sp() - (pageZero ? 2 : 4);
       set_sp(sp);
-      store2(sp, PC);
-#if 0 // only in huge model
-      store2(sp+2, ...
-#endif
+      store2(sp, PC&0xffff);
+      if (!pageZero) {
+       store2(sp+2, (PC>>16)&0xff);
+      }
       jmpaddr = reg2(RI_07);
       jmpaddr *= 2;
-      PC = (PC + jmpaddr) & 0xfffffffe;
+      PC = (PC + jmpaddr) & 0xfffffe;
     }
     break;
-    /* fixme 2 more... */ /* johan: which ones? */
-  }
-  return(resGO);
-}
-int
-cl_xa::inst_RET(uint code, int operands)
-{
-  unsigned int retaddr;
-  unsigned short sp;
-  sp = get_sp();
-  retaddr = get2(sp);
-#if 0 // only in huge model
-  retaddr |= get2(sp+2) << 16;
-#endif
-  set_sp(sp+2);
-  PC = retaddr;
-  return(resGO);
-}
-int
-cl_xa::inst_Bcc(uint code, int operands)
-{
-  return(resGO);
-}
-int
-cl_xa::inst_JB(uint code, int operands)
-{
-  short bitAddr=((code&0x3)<<8) + fetch1();
-  short jmpAddr = (fetch1() * 2);
-  if (get_bit(bitAddr)) {
-    PC = (PC+jmpAddr)&0xfffffe;
   }
   return(resGO);
 }
-int
-cl_xa::inst_JNB(uint code, int operands)
-{
-  short bitAddr=((code&0x3)<<8) + fetch1();
-  short jmpAddr = (fetch1() * 2);
-  if (!get_bit(bitAddr)) {
-    PC = (PC+jmpAddr)&0xfffffe;
-  }
-  return(resGO);
-  return(resGO);
-}
-int
-cl_xa::inst_CJNE(uint code, int operands)
+
+int cl_xa::inst_CJNE(uint code, int operands)
 {
   switch(operands) {
     case REG_DIRECT_REL8:
@@ -536,23 +348,54 @@ cl_xa::inst_CJNE(uint code, int operands)
   }
   return(resGO);
 }
-int
-cl_xa::inst_DJNZ(uint code, int operands)
+
+int cl_xa::inst_CLR(uint code, int operands)
+{
+  unsigned short bitAddr = (code&0x03 << 8) + fetch();
+  // fixme: implement
+  bitAddr=bitAddr;
+  return(resGO);
+}
+
+int cl_xa::inst_CMP(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 cmp1
+#undef FUNC2
+#define FUNC2 cmp2
+#include "inst_gen.cc"
+  return(resGO);
+}
+int cl_xa::inst_CPL(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_DA(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_DIV(uint code, int operands)
+{
+  return(resGO);
+}
+
+int cl_xa::inst_DJNZ(uint code, int operands)
 {
+  // update N Z flags.
   switch(operands) {
     case REG_REL8:
     {
-       int addr = (fetch1() * 2);
+       int addr = ( ((char)fetch1()) * 2);
        if (code & 0x800) {  // word op
          unsigned short tmp = mov2(0, reg2(RI_F0)-1);
          set_reg2(RI_F0, tmp);
          if (tmp != 0)
-           PC += addr;
+           PC = (PC + addr) & 0xfffffe;
        } else {
          unsigned char tmp = mov1(0, reg1(RI_F0)-1);
          set_reg1(RI_F0, tmp);
          if (tmp != 0)
-           PC += addr;
+           PC = (PC + addr) & 0xfffffe;
        }
     }
     break;
@@ -579,18 +422,60 @@ cl_xa::inst_DJNZ(uint code, int operands)
 
   return(resGO);
 }
-int
-cl_xa::inst_JZ(uint code, int operands)
+
+int cl_xa::inst_FCALL(uint code, int operands)
+{
+  return(resGO);
+}
+
+int cl_xa::inst_FJMP(uint code, int operands)
 {
-  /* reg1(8) = R4L, is ACC for MCS51 compatiblility */
-  short saddr = (fetch1() * 2);
-  if (reg1(8)==0) {
-      PC += saddr;
+  return(resGO);
+}
+
+int cl_xa::inst_JB(uint code, int operands)
+{
+  short bitAddr=((code&0x3)<<8) + fetch1();
+  short jmpAddr = (fetch1() * 2);
+  if (get_bit(bitAddr)) {
+    PC = (PC+jmpAddr)&0xfffffe;
+  }
+  return(resGO);
+}
+int cl_xa::inst_JBC(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_JNB(uint code, int operands)
+{
+  short bitAddr=((code&0x3)<<8) + fetch1();
+  short jmpAddr = (fetch1() * 2);
+  if (!get_bit(bitAddr)) {
+    PC = (PC+jmpAddr)&0xfffffe;
+  }
+  return(resGO);
+  return(resGO);
+}
+int cl_xa::inst_JMP(uint code, int operands)
+{
+  int jmpAddr;
+
+  switch(operands) {
+    case REL16:
+    {
+      jmpAddr = (signed short)fetch2()*2;
+      PC = (PC + jmpAddr) & 0xfffffe;
+    }
+    break;
+    case IREG:
+      PC &= 0xff0000;
+      PC |= (reg2(RI_07) & 0xfffe);  /* word aligned */
+    break;
+    /* fixme 2 more... */
   }
   return(resGO);
 }
-int
-cl_xa::inst_JNZ(uint code, int operands)
+int cl_xa::inst_JNZ(uint code, int operands)
 {
   short saddr = (fetch1() * 2);
   /* reg1(8) = R4L, is ACC for MCS51 compatiblility */
@@ -599,21 +484,285 @@ cl_xa::inst_JNZ(uint code, int operands)
   }
   return(resGO);
 }
-int
-cl_xa::inst_BKPT(uint code, int operands)
+int cl_xa::inst_JZ(uint code, int operands)
+{
+  /* reg1(8) = R4L, is ACC for MCS51 compatiblility */
+  short saddr = (fetch1() * 2);
+  if (reg1(8)==0) {
+      PC += saddr;
+  }
+  return(resGO);
+}
+int cl_xa::inst_LEA(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_LSR(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_MOV(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 mov1
+#undef FUNC2
+#define FUNC2 mov2
+#include "inst_gen.cc"
+  return(resGO);
+}
+int cl_xa::inst_MOVC(uint code, int operands)
+{
+  switch (operands) {
+    case REG_IREGINC:
+    {
+      short srcreg = reg2(RI_07);
+      if (code & 0x0800) {  /* word op */
+        set_reg2( RI_F0,
+                  mov2( reg2(RI_F0),
+                        getcode2(srcreg)
+                      )
+                );
+      } else {
+        set_reg1( RI_F0,
+                  mov1( reg1(RI_F0),
+                        getcode1(srcreg)
+                      )
+                );
+      }
+      if (operands == REG_IREGINC) {
+        set_reg2(RI_07,  srcreg+1);
+      }
+    }
+    break;
+    case A_APLUSDPTR:
+    {  /* R4l=ACC, R6=DPTR */
+      unsigned int addr = (PC & 0xff0000) | (reg1(4) + reg2(6));
+      unsigned short result;
+      unsigned char flags;
+      flags = get_psw();
+
+      flags &= ~(BIT_Z | BIT_N); /* clear these bits */
+      result = getcode1(addr);
+      set_reg1( 4, result);
+      if (result == 0) flags |= BIT_Z;
+      if (result & 0x80) flags |= BIT_N;
+      set_psw(flags);
+    }
+    break;
+    case A_APLUSPC:
+    {  /* R4l=ACC, R6=DPTR */
+      unsigned int addr = (PC + reg1(4));
+      unsigned short result;
+      unsigned char flags;
+      flags = get_psw();
+
+      flags &= ~(BIT_Z | BIT_N); /* clear these bits */
+      result = getcode1(addr);
+      set_reg1( 4, result);
+      if (result == 0) flags |= BIT_Z;
+      if (result & 0x80) flags |= BIT_N;
+      set_psw(flags);
+    }
+    break;
+  }
+  return(resGO);
+}
+int cl_xa::inst_MOVS(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_MOVX(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_MUL(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_NEG(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_NOP(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_NORM(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_OR(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 or1
+#undef FUNC2
+#define FUNC2 or2
+#include "inst_gen.cc"
+  return(resGO);
+}
+
+int cl_xa::inst_ORL(uint code, int operands)
+{
+  return(resGO);
+}
+
+int cl_xa::inst_POP(uint code, int operands)
+{
+  switch(operands) {
+    case DIRECT:
+    {
+      unsigned short sp;
+      unsigned short direct_addr = ((operands & 0x7) << 8) | fetch();
+
+      sp = get_sp();
+      if (code & 0x0800) {  /* word op */
+        set_word_direct(direct_addr, get2(sp) );
+      } else {
+        set_byte_direct(direct_addr, get2(sp) & 0xff );
+      }
+      set_sp(sp+2);
+    }
+    break;
+
+    case RLIST:
+      // fixme: implement
+      unsigned char rlist = fetch();
+      rlist = rlist; //shutup compiler
+    break;
+  }
+  return(resGO);
+}
+
+int cl_xa::inst_PUSH(uint code, int operands)
 {
+  switch(operands) {
+    case DIRECT:
+    {
+      unsigned short sp;
+      unsigned short direct_addr = ((operands & 0x7) << 8) | fetch();
+
+      sp = get_sp()-2;
+      set_sp(sp);
+      if (code & 0x0800) {  /* word op */
+        store2( sp, get_word_direct(direct_addr));
+      } else {
+        store2( sp, get_byte_direct(direct_addr));
+      }
+    }
+    break;
+
+    case RLIST:
+      // fixme: implement
+      unsigned char rlist = fetch();
+      rlist = rlist; //shutup compiler
+    break;
+  }
+  
   return(resGO);
 }
-int
-cl_xa::inst_TRAP(uint code, int operands)
+int cl_xa::inst_RESET(uint code, int operands)
 {
   return(resGO);
 }
-int
-cl_xa::inst_RESET(uint code, int operands)
+int cl_xa::inst_RET(uint code, int operands)
+{
+  unsigned int retaddr;
+  unsigned short sp;
+  bool pageZero=get_scr()&1;
+
+  sp = get_sp();
+  retaddr = get2(sp);
+  if (!pageZero) {
+    retaddr |= get2(sp+2) << 16;
+    set_sp(sp+4);
+  } else {
+    set_sp(sp+2);
+  }
+  PC = retaddr;
+  return(resGO);
+}
+int cl_xa::inst_RETI(uint code, int operands)
+{
+  unsigned int retaddr;
+  unsigned short sp;
+  bool pageZero=get_scr()&1;
+
+  sp = get_sp();
+  set_psw(get2(sp));
+  retaddr = get2(sp+2);
+  if (!pageZero) {
+    retaddr |= get2(sp+4) << 16;
+    set_sp(sp+6);
+  } else {
+    set_sp(sp+4);
+  }
+  PC = retaddr;
+  return(resGO);
+}
+int cl_xa::inst_RL(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_RLC(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_RR(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_RRC(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_SETB(uint code, int operands)
+{
+  unsigned short bitAddr = (code&0x03 << 8) + fetch();
+  // fixme: implement
+  bitAddr=bitAddr;
+  return(resGO);
+}
+
+int cl_xa::inst_SEXT(uint code, int operands)
 {
   return(resGO);
 }
 
+int cl_xa::inst_SUB(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 sub1
+#undef FUNC2
+#define FUNC2 sub2
+#include "inst_gen.cc"
+  return(resGO);
+}
+
+int cl_xa::inst_SUBB(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 subb1
+#undef FUNC2
+#define FUNC2 subb2
+#include "inst_gen.cc"
+  return(resGO);
+}
+int cl_xa::inst_TRAP(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_XCH(uint code, int operands)
+{
+  return(resGO);
+}
+int cl_xa::inst_XOR(uint code, int operands)
+{
+#undef FUNC1
+#define FUNC1 xor1
+#undef FUNC2
+#define FUNC2 xor2
+#include "inst_gen.cc"
+  return(resGO);
+}
 
 /* End of xa.src/inst.cc */