diff options
| author | Xavier ASUS <xavi92psx@gmail.com> | 2019-10-18 00:31:54 +0200 |
|---|---|---|
| committer | Xavier ASUS <xavi92psx@gmail.com> | 2019-10-18 00:31:54 +0200 |
| commit | 268a53de823a6750d6256ee1fb1e7707b4b45740 (patch) | |
| tree | 42c1799a9a82b2f7d9790ee9fe181d72a7274751 /sim/ucsim/tlcs.src/tlcs.cc | |
| download | sdcc-gas-268a53de823a6750d6256ee1fb1e7707b4b45740.tar.gz | |
sdcc-3.9.0 fork implementing GNU assembler syntax
This fork aims to provide better support for stm8-binutils
Diffstat (limited to 'sim/ucsim/tlcs.src/tlcs.cc')
| -rw-r--r-- | sim/ucsim/tlcs.src/tlcs.cc | 1827 |
1 files changed, 1827 insertions, 0 deletions
diff --git a/sim/ucsim/tlcs.src/tlcs.cc b/sim/ucsim/tlcs.src/tlcs.cc new file mode 100644 index 0000000..235ba26 --- /dev/null +++ b/sim/ucsim/tlcs.src/tlcs.cc @@ -0,0 +1,1827 @@ +/* + * Simulator of microcontrollers (tlcs.src/tlcs.cc) + * + * Copyright (C) 2016,16 Drotos Daniel, Talker Bt. + * + * To contact author send email to drdani@mazsola.iit.uni-miskolc.hu + * + */ + +/* This file is part of microcontroller simulator: ucsim. + +UCSIM is free software; you can redistribute it and/or modify +it under the terms of the GNU General Public License as published by +the Free Software Foundation; either version 2 of the License, or +(at your option) any later version. + +UCSIM is distributed in the hope that it will be useful, +but WITHOUT ANY WARRANTY; without even the implied warranty of +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +GNU General Public License for more details. + +You should have received a copy of the GNU General Public License +along with UCSIM; see the file COPYING. If not, write to the Free +Software Foundation, 59 Temple Place - Suite 330, Boston, MA +02111-1307, USA. */ +/*@1@*/ + +#include "ddconfig.h" + +#include <stdio.h> +#include <stdlib.h> +#include <ctype.h> +#include "i_string.h" + +// prj +#include "pobjcl.h" + +// sim +#include "simcl.h" +#include "memcl.h" +#include "stackcl.h" + +// local +#include "tlcscl.h" +#include "glob.h" + + +/* + * Base type of TLCS microcontrollers + */ + +cl_tlcs::cl_tlcs(class cl_sim *asim): + cl_uc(asim) +{ + //type= CPU_TLCS; + //sleep_executed= 0; + regs8= new cl_address_space("regs8", 0, 16, 8); + regs8->init(); + regs8->get_cell(0)->decode((t_mem*)®.raf.a); + regs8->get_cell(1)->decode((t_mem*)®.raf.f); + regs8->get_cell(2)->decode((t_mem*)®.rbc.b); + regs8->get_cell(3)->decode((t_mem*)®.rbc.c); + regs8->get_cell(4)->decode((t_mem*)®.rde.d); + regs8->get_cell(5)->decode((t_mem*)®.rde.e); + regs8->get_cell(6)->decode((t_mem*)®.rhl.h); + regs8->get_cell(7)->decode((t_mem*)®.rhl.l); + + regs8->get_cell(8)->decode((t_mem*)®.ralt_af.alt_a); + regs8->get_cell(9)->decode((t_mem*)®.ralt_af.alt_f); + regs8->get_cell(10)->decode((t_mem*)®.ralt_bc.alt_b); + regs8->get_cell(11)->decode((t_mem*)®.ralt_bc.alt_c); + regs8->get_cell(12)->decode((t_mem*)®.ralt_de.alt_d); + regs8->get_cell(13)->decode((t_mem*)®.ralt_de.alt_e); + regs8->get_cell(14)->decode((t_mem*)®.ralt_hl.alt_h); + regs8->get_cell(15)->decode((t_mem*)®.ralt_hl.alt_l); + + regs16= new cl_address_space("regs16", 0, 11, 16); + regs16->init(); + + regs16->get_cell(0)->decode((t_mem*)®.af); + regs16->get_cell(1)->decode((t_mem*)®.bc); + regs16->get_cell(2)->decode((t_mem*)®.de); + regs16->get_cell(3)->decode((t_mem*)®.hl); + regs16->get_cell(4)->decode((t_mem*)®.ix); + regs16->get_cell(5)->decode((t_mem*)®.iy); + regs16->get_cell(6)->decode((t_mem*)®.sp); + regs16->get_cell(7)->decode((t_mem*)®.alt_af); + regs16->get_cell(8)->decode((t_mem*)®.alt_bc); + regs16->get_cell(9)->decode((t_mem*)®.alt_de); + regs16->get_cell(10)->decode((t_mem*)®.alt_hl); + + address_spaces->add(regs8); + address_spaces->add(regs16); +} + +int +cl_tlcs::init(void) +{ + class cl_var *v; + + cl_uc::init(); /* Memories now exist */ + //ram= address_space(MEM_IRAM_ID); + //rom= address_space(MEM_ROM_ID); + + // zero out ram(this is assumed in regression tests) + for (int i=0x8000; i<0x10000; i++) { + nas->set((t_addr) i, 0); + } + + vars->add(v= new cl_var(cchars("A"), regs8, 0, "")); + v->init(); + vars->add(v= new cl_var(cchars("F"), regs8, 1, "")); + v->init(); + vars->add(v= new cl_var(cchars("B"), regs8, 2, "")); + v->init(); + vars->add(v= new cl_var(cchars("C"), regs8, 3, "")); + v->init(); + vars->add(v= new cl_var(cchars("D"), regs8, 4, "")); + v->init(); + vars->add(v= new cl_var(cchars("E"), regs8, 5, "")); + v->init(); + vars->add(v= new cl_var(cchars("H"), regs8, 6, "")); + v->init(); + vars->add(v= new cl_var(cchars("L"), regs8, 7, "")); + v->init(); + + vars->add(v= new cl_var(cchars("ALT_A"), regs8, 8, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_F"), regs8, 9, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_B"), regs8, 10, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_C"), regs8, 11, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_D"), regs8, 12, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_E"), regs8, 13, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_H"), regs8, 14, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_L"), regs8, 15, "")); + v->init(); + + vars->add(v= new cl_var(cchars("AF"), regs16, 0, "")); + v->init(); + vars->add(v= new cl_var(cchars("BC"), regs16, 1, "")); + v->init(); + vars->add(v= new cl_var(cchars("DE"), regs16, 2, "")); + v->init(); + vars->add(v= new cl_var(cchars("HL"), regs16, 3, "")); + v->init(); + vars->add(v= new cl_var(cchars("IX"), regs16, 4, "")); + v->init(); + vars->add(v= new cl_var(cchars("IY"), regs16, 5, "")); + v->init(); + vars->add(v= new cl_var(cchars("SP"), regs16, 6, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_AF"), regs16, 7, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_BC"), regs16, 8, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_DE"), regs16, 9, "")); + v->init(); + vars->add(v= new cl_var(cchars("ALT_HL"), regs16, 11, "")); + v->init(); + + return(0); +} + +char * +cl_tlcs::id_string(void) +{ + return((char*)"unspecified TLCS"); +} + + +void +cl_tlcs::mk_hw_elements(void) +{ + //class cl_base *o; + //hws->add(o= new cl_port(this)); + //o->init(); + cl_uc::mk_hw_elements(); +} + + +void +cl_tlcs::make_memories(void) +{ + class cl_address_space *as; + + rom= nas= as= new cl_address_space(cchars("nas"), 0, 0x10000, 8); + as->init(); + address_spaces->add(as); + xas= as= new cl_address_space(cchars("xas"), 0, 0x10000, 8); + as->init(); + address_spaces->add(as); + yas= as= new cl_address_space(cchars("yas"), 0, 0x10000, 8); + as->init(); + address_spaces->add(as); + + class cl_address_decoder *ad; + class cl_memory_chip *chip; + + chip= new cl_memory_chip("nas_chip", 0x10000, 8); + chip->init(); + memchips->add(chip); + ad= new cl_address_decoder(as= nas, + chip, 0, 0xffff, 0); + ad->init(); + as->decoders->add(ad); + ad->activate(0); + + //chip= new cl_memory_chip("das_chip", 0x10000, 8); + //chip->init(); + //memchips->add(chip); + ad= new cl_address_decoder(as= xas, + chip, 0, 0xffff, 0); + ad->init(); + as->decoders->add(ad); + ad->activate(0); + + ad= new cl_address_decoder(as= yas, + chip, 0, 0xffff, 0); + ad->init(); + as->decoders->add(ad); + ad->activate(0); +} + + +struct dis_entry * +cl_tlcs::dis_tbl(void) +{ + return disass_tlcs; +} + +//virtual struct name_entry *sfr_tbl(void); +//virtual struct name_entry *bit_tbl(void); + +const char * +cl_tlcs::regname_r(u8_t r) +{ + switch (r & 7) + { + case 0: return "B"; + case 1: return "C"; + case 2: return "D"; + case 3: return "E"; + case 4: return "H"; + case 5: return "L"; + case 6: return "A"; + default: return "?"; + } +} + +const char * +cl_tlcs::regname_R(u8_t R) +{ + switch (R & 7) + { + case 0: return "BC"; + case 1: return "DE"; + case 2: return "HL"; + case 4: return "IX"; + case 5: return "IY"; + case 6: return "SP"; + default: return "?"; + } +} + +const char * +cl_tlcs::regname_Q(u8_t Q) +{ + switch (Q & 7) + { + case 0: return "BC"; + case 1: return "DE"; + case 2: return "HL"; + case 4: return "IX"; + case 5: return "IY"; + case 6: return "AF"; + default: return "?"; + } +} + +const char * +cl_tlcs::regname_i(u8_t i) +{ + switch (i & 3) + { + case 0: return "IX"; + case 1: return "IY"; + case 2: return "SP"; + default: return "?"; + } +} + +const char * +cl_tlcs::bitname(u8_t b) +{ + switch (b & 0x07) + { + case 0: return "0"; + case 1: return "1"; + case 2: return "2"; + case 3: return "3"; + case 4: return "4"; + case 5: return "5"; + case 6: return "6"; + case 7: return "7"; + } + return "?"; +} + +const char * +cl_tlcs::condname_cc(u8_t cc) +{ + switch (cc & 0xf) + { + case 0: return "F,"; + case 1: return "LT,"; + case 2: return "LE,"; + case 3: return "ULE,"; + case 4: return "OV,"; + case 5: return "M,"; + case 6: return "Z,"; + case 7: return "C,"; + case 8: return ""; + case 9: return "GE,"; + case 10: return "GT,"; + case 11: return "UGT,"; + case 12: return "NOV,"; + case 13: return "P,"; + case 14: return "NZ,"; + case 15: return "NC,"; + } + return "?"; +} + +const char * +cl_tlcs::condname_C(u8_t cc) +{ + switch (cc & 0xf) + { + case 0: return "F"; + case 1: return "LT"; + case 2: return "LE"; + case 3: return "ULE"; + case 4: return "OV"; + case 5: return "M"; + case 6: return "Z"; + case 7: return "C"; + case 8: return ""; + case 9: return "GE"; + case 10: return "GT"; + case 11: return "UGT"; + case 12: return "NOV"; + case 13: return "P"; + case 14: return "NZ"; + case 15: return "NC"; + } + return "?"; +} + +char * +cl_tlcs::disass(t_addr addr, const char *sep) +{ + struct dis_entry *de; + u64_t c; + int i; + chars s(""); + char *buf, *t, l[20]; + + c= 0; + for (i= 7; i>=0; i--) + { + u8_t cb= rom->get(addr+i); + c<<= 8; + c|= cb; + } + + de= dis_tbl(); + while (de->mnemonic != NULL) + { + if ((c & de->mask) == u64_t(de->code)) + break; + de++; + } + if (de->mnemonic == NULL) + return strdup("?"); + + for (t= (char*)de->mnemonic; *t; t++) + { + if (*t == '%') + { + t++; + switch (*t) + { + case 'r': /* r in 1st byte */ s+= regname_r(c); break; + case 'p': /* r in 2nd byte */ s+= regname_r(c>>8); break; + case 't': /* r in 3rd byte */ s+= regname_r(c>>16); break; + case 'T': /* r in 4th byte */ s+= regname_r(c>>24); break; + case 'R': /* rr in 1st byte */ s+= regname_R(c); break; + case 's': /* rr in 2nd byte */ s+= regname_R(c>>8); break; + case 'u': /* rr in 3rd byte */ s+= regname_R(c>>16); break; + case 'U': /* rr in 4th byte */ s+= regname_R(c>>24); break; + case 'Q': /* qq in 1st byte */ s+= regname_Q(c); break; + case 'I': /* ix in 1st byte */ s+= regname_i(c); break; + case 'i': /* ix in 2nd byte */ s+= regname_i(c>>8); break; + case 'j': /* ix in 3rd byte */ s+= regname_i(c>>16); break; + case 'J': /* ix in 4th byte */ s+= regname_i(c>>24); break; + case 'a': /* b in 1st byte */ s+= bitname(c); break; + case 'b': /* b in 2nd byte */ s+= bitname(c>>8); break; + case 'B': /* b in 3rd byte */ s+= bitname(c>>16); break; + case 'e': /* b in 4th byte */ s+= bitname(c>>24); break; + case 'y': /* cc in 1st byte */ s+= condname_cc(c); break; // with , + case 'c': /* cc in 2nd byte */ s+= condname_cc(c>>8); break; // with , + case 'C': /* cc in 2nd byte */ s+= condname_C(c>>8); break; // without , + case 'f': /* cc in 4th byte */ s+= condname_cc(c>>24); break; // with , + case 'F': /* cc in 3rd byte */ s+= condname_cc(c>>16); break; // with , + case 'n': /* n in 2nd byte */ snprintf(l,19,"%02x",(int)((c>>8)&0xff));s+= l; break; + case 'N': /* n in 3rd byte */ snprintf(l,19,"%02x",(int)((c>>16)&0xff));s+= l; break; + case 'o': /* n in 4th byte */ snprintf(l,19,"%02x",(int)((c>>24)&0xff));s+= l; break; + case 'O': /* n in 5th byte */ snprintf(l,19,"%02x",(int)((c>>32)&0xff));s+= l; break; + case '1': /* PC+2+d in 2nd byte */ snprintf(l,19,"0x%04x",(int)(addr+2+i8_t((c>>8)&0xff))); s+= l; break; + case 'd': /* d in 2nd byte */ snprintf(l,19,"%+d",(int)(i8_t((c>>8)&0xff))); s+= l; break; + case 'D': /* cd in 2,3 byte */ snprintf(l,19,"0x%04x",(int)(addr+3+i16_t((c>>8)&0xffff))); s+= l; break; + case 'M': /* mn in 2,3 byte */ snprintf(l,19,"0x%04x",(int)((c>>8)&0xffff)); s+= l; break; + case 'm': /* mn in 3,4 byte */ snprintf(l,19,"0x%04x",(int)((c>>16)&0xffff)); s+= l; break; + case 'X': /* mn in 4,5 byte */ snprintf(l,19,"0x%04x",(int)((c>>24)&0xffff)); s+= l; break; + case 'x': /* mn in 5,6 byte */ snprintf(l,19,"0x%04x",(int)((c>>32)&0xffff)); s+= l; break; + default: s+= '?'; break; + } + } + else + s+= *t; + } + + buf= strdup(s); + return buf; +} + +int +cl_tlcs::inst_length(t_addr addr) +{ + struct dis_entry *de; + u64_t c; + int i; + + c= 0; + for (i= 7; i>=0; i--) + { + u8_t cb= rom->get(addr+i); + c<<= 8; + c|= cb; + } + + de= dis_tbl(); + while (de->mnemonic != NULL) + { + if ((c & de->mask) == u64_t(de->code)) + break; + de++; + } + if (de->mnemonic == NULL) + return 1; + if (de->length == 1) + return 1; + else + return de->length; +} + +void +cl_tlcs::print_regs(class cl_console_base *con) +{ + con->dd_printf("SZIHXVNC Flags= 0x%02x %3d %c ", + reg.raf.f, reg.raf.f, isprint(reg.raf.f)?reg.raf.f:'.'); + con->dd_printf("A= 0x%02x %3d %c\n", + reg.raf.a, reg.raf.a, isprint(reg.raf.a)?reg.raf.a:'.'); + con->dd_printf("%c%c%c%c%c%c%c%c\n", + (reg.raf.f&FLAG_S)?'1':'0', + (reg.raf.f&FLAG_Z)?'1':'0', + (reg.raf.f&FLAG_I)?'1':'0', + (reg.raf.f&FLAG_H)?'1':'0', + (reg.raf.f&FLAG_X)?'1':'0', + (reg.raf.f&FLAG_V)?'1':'0', + (reg.raf.f&FLAG_N)?'1':'0', + (reg.raf.f&FLAG_C)?'1':'0'); + con->dd_printf("BC= 0x%04x [BC]= %02x %3d %c ", + reg.bc, nas->get(reg.bc), nas->get(reg.bc), + isprint(nas->get(reg.bc))?nas->get(reg.bc):'.'); + con->dd_printf("DE= 0x%04x [DE]= %02x %3d %c ", + reg.de, nas->get(reg.de), nas->get(reg.de), + isprint(nas->get(reg.de))?nas->get(reg.de):'.'); + con->dd_printf("HL= 0x%04x [HL]= %02x %3d %c\n", + reg.hl, nas->get(reg.hl), nas->get(reg.hl), + isprint(nas->get(reg.hl))?nas->get(reg.hl):'.'); + con->dd_printf("IX= 0x%04x [IX]= %02x %3d %c ", + reg.ix, xas->get(reg.ix), xas->get(reg.ix), + isprint(xas->get(reg.ix))?xas->get(reg.ix):'.'); + con->dd_printf("IY= 0x%04x [IY]= %02x %3d %c ", + reg.iy, yas->get(reg.iy), yas->get(reg.iy), + isprint(yas->get(reg.iy))?yas->get(reg.iy):'.'); + con->dd_printf("SP= 0x%04x [SP]= %02x %3d %c\n", + reg.sp, nas->get(reg.sp), nas->get(reg.sp), + isprint(nas->get(reg.sp))?nas->get(reg.sp):'.'); + + print_disass(PC, con); +} + +int +cl_tlcs::exec_inst(void) +{ + t_mem c1, c2, c3, c4;//, c5, c6; + int res= resGO; + + instPC= PC; + + if (fetch(&c1)) + return resBREAKPOINT; + tick(1); + + switch (c1) + { + case 0x00: break; // NOP //res= resGO; + case 0x01: res= resHALT; break; // HALT + case 0x02: reg.raf.f&= ~FLAG_I; break; // DI + case 0x03: reg.raf.f|= FLAG_I; break; // EI + case 0x08: res= ex_de_hl(); break; + case 0x09: res= ex_af_alt_af(); break; + case 0x0a: res= exx(); break; + case 0x0b: res= inst_daa_a(); break; + case 0x0d: res= inst_scf(); break; + case 0x0c: res= inst_rcf(); break; + case 0x0e: res= inst_ccf(); break; + case 0x10: res= inst_cpl_a(); break; + case 0x11: res= inst_neg_a(); break; + case 0x17: // LDAR HL,$+2+cd + c2= fetch(); + c3= fetch(); + reg.hl= PC + i16_t(c3*256 + c2); + break; + case 0x1e: res= inst_ret(); break; + case 0x1f: res= inst_reti(); break; + case 0x37: // LD (0ffw),n + c2= fetch(); + c3= fetch(); + cell_n(c2)->write(c3); + vc.wr++; + break; + case 0x3F: // LDW (0ffw),mn + c2= fetch(); + c3= fetch(); + c4= fetch(); + write16(0xff00+c2, c4*256 + c3); + vc.wr+= 2; + break; + case 0x97: c2= fetch(); inst_inc16(t_addr(0xff00+c2)); break; // INCW (0ffn) + case 0x9F: c2= fetch(); inst_dec16(t_addr(0xff00+c2)); break; // DECW (0ffn) + case 0xa0: reg.raf.a= op_rlc(reg.raf.a, false); break; // RLCA + case 0xa1: reg.raf.a= op_rrc(reg.raf.a, false); break; // RRCA + case 0xa2: reg.raf.a= op_rl(reg.raf.a, false); break; // RLA + case 0xa3: reg.raf.a= op_rr(reg.raf.a, false); break; // RRA + case 0xa4: reg.raf.a= op_sla(reg.raf.a, false); break; // SLAA + case 0xa5: reg.raf.a= op_sra(reg.raf.a, false); break; // SRAA + case 0xa6: reg.raf.a= op_sla(reg.raf.a, false); break; // SLLA (=SLAA) + case 0xa7: reg.raf.a= op_srl(reg.raf.a, false); break; // SRLA + case 0xff: res= inst_swi(); break; + case 0xe3: + c2= fetch(); + c3= fetch(); + c4= fetch(); + res= exec_inst4_e3(c1, c2, c3, c4); + break; + case 0xe7: + c2= fetch(); + c3= fetch(); + res= exec_inst3_e7(c1, c2, c3); + break; + case 0xeb: + c2= fetch(); + c3= fetch(); + c4= fetch(); + res= exec_inst4_eb(c1, c2, c3, c4); + break; + case 0xef: + c2= fetch(); + c3= fetch(); + res= exec_inst4_ef(c1, c2, c3); + break; + case 0xf3: // c1 + c2= fetch(); + res= exec_inst2_f3(c2); + break; + case 0xf7: // c1 + c2= fetch(); + res= exec_inst2_f7(c2); + break; + //case 0xfe: // c1 + //c2= fetch(); + //res= exec_inst2_fe(c2); + //break; + default: + { + switch (c1 & 0xfc) // c1= XX+ix + { + case 0x14: // ADD ix,mn + { + u16_t *ra= aof_reg16_ix(c1); + c2= fetch(); + c3= fetch(); + *ra= op_add16(*ra, c3*256 + c2); + break; + } + case 0xf0: res= exec_inst3_f0ix(c1); break; // F0+ix d XX + case 0xf4: // F4+ix d XX [n [m]] + c2= fetch(); + c3= fetch(); + res= exec_inst4_f4ix(c1, c2, c3); + break; + default: + switch (c1 & 0xf8) // c1= XX+r,rr,... + { + // r, g, etc coded in single byte instruction + case 0x20: reg.raf.a= *aof_reg8(c1); break; // LD A,r + case 0x28: *aof_reg8(c1)= reg.raf.a; break; // LD r,A + case 0x38: // LD rr,mn + c2= fetch(); + c3= fetch(); + *aof_reg16_rr(c1)= c2 + c3*256; + break; + case 0x40: reg.hl= *aof_reg16_rr(c1); break; // LD HL,rr + case 0x48: *aof_reg16_rr(c1)= reg.hl; break; // LD rr,HL + case 0x50: exec_push(PC-1, *aof_reg16_qq(c1)); break; // PUSH qq + case 0x58: res= inst_pop(c1); break; // POP qq + case 0x80: *aof_reg8(c1)= op_inc(*aof_reg8(c1)); break; // INC r + case 0x88: *aof_reg8(c1)= op_dec(*aof_reg8(c1)); break; // DEC r + case 0x90: *aof_reg16_rr(c1)= op_inc16(*aof_reg16_rr(c1)); break; // INC rr + case 0x98: *aof_reg16_rr(c1)= op_dec16(*aof_reg16_rr(c1)); break; // DEC rr + default: + // no more left, check for two byte instructions + res= exec_inst2(c1); + break; + } + break; + } + break; + } + } + + return res; +} + +/* + * Decode two byte instructions + ************************************************************************************ + */ + +int +cl_tlcs::exec_inst2(u8_t c1) +{ + u8_t c2= fetch(); + int res= resGO; + class cl_memory_cell *n= cell_n(c2); + + // first, handle cases where first byte is fix + switch (c1) + { + case 0x07: inst_incx(n); break; // INCX (0ffn) + case 0x0F: inst_decx(n); break; // DECX (0ffn) + case 0x12: reg.hl= reg.rhl.l * c2; break; // MUL HL,n + case 0x13: inst_div_hl(c2); break; // DIV HL,n + case 0x18: inst_djnz_b(i8_t(c2)); break; // DJNZ $+2+d + case 0x19: inst_djnz_bc(i8_t(c2)); break; // DJNZ BC,$+2+d + case 0x27: reg.raf.a= n->read(); break; // LD A,(0ffn) + case 0x2F: n->write(reg.raf.a); vc.wr++; break; // LD (0ffn),A + case 0x47: reg.hl= mem16(0xff00 + c2); vc.rd+= 2; break; // LD HL,(0ffn) + case 0x4f: write16(0xff00+c2, reg.hl); vc.wr+= 2; break; // LD (0xffn),HL + case 0x60: inst_add_a(n); break; // ADD A,(0ffn) + case 0x61: inst_adc_a(n); break; // ADC A,(0ffn) + case 0x62: inst_sub_a(n); break; // SUB A,(0ffn) + case 0x63: inst_sbc_a(n); break; // SBC A,(0ffn) + case 0x64: inst_and_a(n); break; // AND A,(0ffn) + case 0x65: inst_xor_a(n); break; // XOR A,(0ffn) + case 0x66: inst_or_a(n); break; // OR A,(0ffn) + case 0x67: op_cp_a(n); break; // CP A,(0ffn) + case 0x68: reg.raf.a= op_add_a(c2); break; // ADD A,n + case 0x69: inst_adc_a(c2); break; // ADC A,n + case 0x6A: inst_sub_a(c2); break; // SUB A,n + case 0x6B: inst_sbc_a(c2); break; // SBC A,n + case 0x6C: inst_and_a(c2); break; // AND A,n + case 0x6D: inst_xor_a(c2); break; // XOR A,n + case 0x6E: inst_or_a(c2); break; // OR A,n + case 0x6F: op_cp_a(c2); break; // CP A,n + case 0x70: reg.hl= op_add_hl(t_addr(0xff00+c2)); break; // ADD HL,(0ffn) + case 0x71: reg.hl= op_adc_hl(t_addr(0xff00+c2)); break; // ADC HL,(0ffn) + case 0x72: reg.hl= op_sub_hl(t_addr(0xff00+c2)); break; // SUB HL,(0ffn) + case 0x73: reg.hl= op_sbc_hl(t_addr(0xff00+c2)); break; // SBC HL,(0ffn) + case 0x74: reg.hl= op_and_hl(t_addr(0xff00+c2)); break; // AND HL,(0ffn) + case 0x75: reg.hl= op_xor_hl(t_addr(0xff00+c2)); break; // XOR HL,(0ffn) + case 0x76: reg.hl= op_or_hl(t_addr(0xff00+c2)); break; // OR HL,(0ffn) + case 0x77: op_sub_hl(t_addr(0xff00+c2)); break; // CP HL,(0ffn) + case 0x87: inst_inc(n); break; // INC (0ffn) + case 0x8F: inst_dec(n); break; // DEC (0ffn) + default: + // now handle cases where first byte is not fix + switch (c1 & 0xf8) + { + case 0x30: *aof_reg8(c1)= c2; break; // LD r,n + case 0xa8: inst_bit(n, c1); break; // BIT b,(0ffn) + case 0xb0: inst_res(n, c1); break; // RES b,(0ffn) + case 0xb8: inst_set(n, c1); break; // SET b,(0ffn) + case 0xe0: // e0+gg + res= exec_inst2_e0gg(c1, c2); + break; + case 0xe8: // e8+gg + res= exec_inst2_e8gg(c1, c2); + break; + case 0xf8: // f8+g, f8+gg + res= exec_inst2_f8gg(c1, c2); + break; + default: // pass others to 3 byte decoder + if ((c1 & 0xf0) == 0xc0) // JR [cc,]$+2+d + { + i8_t d= c2; + if (cc(c1)) + PC+= d; + } + else + res= exec_inst3(c1, c2); + break; + } + break; + } + + return res; +} + + +/* F3 XX + */ + +int +cl_tlcs::exec_inst2_f3(u8_t c2) +{ + int res= resGO; + + switch (c2) + { + // handle c1==f3 cases where second byte is fix + case 0x10: res= inst_rld(cell_hl_a()); break; // RLD (HL+A) + case 0x11: res= inst_rrd(cell_hl_a()); break; // RRD (HL+A) + case 0x12: res= inst_mul_hl(cell_hl_a()); break; // MUL HL,(HL+A) + case 0x13: res= inst_div_hl(cell_hl_a()); break; // DIV HL,(HL+A) + case 0x60: res= inst_add_a(cell_hl_a()); break; // ADD A,(HL+A) + case 0x61: res= inst_adc_a(cell_hl_a()); break; // ADC A,(HL+A) + case 0x62: res= inst_sub_a(cell_hl_a()); break; // SUB A,(HL+A) + case 0x63: res= inst_sbc_a(cell_hl_a()); break; // SBC A,(HL+A) + case 0x64: res= inst_and_a(cell_hl_a()); break; // AND A,(HL+A) + case 0x65: res= inst_xor_a(cell_hl_a()); break; // XOR A,(HL+A) + case 0x66: res= inst_or_a(cell_hl_a()); break; // OR A,(HL+A) + case 0x67: res= op_cp_a(cell_hl_a()); break; // CP A,(HL+A) + case 0x70: reg.hl= op_add_hl((t_addr)(reg.hl+reg.raf.a)); break; // ADD HL,(HL+A) + case 0x71: reg.hl= op_adc_hl((t_addr)(reg.hl+reg.raf.a)); break; // ADC HL,(HL+A) + case 0x72: reg.hl= op_sub_hl((t_addr)(reg.hl+reg.raf.a)); break; // SUB HL,(HL+A) + case 0x73: reg.hl= op_sbc_hl((t_addr)(reg.hl+reg.raf.a)); break; // SBC HL,(HL+A) + case 0x74: reg.hl= op_and_hl((t_addr)(reg.hl+reg.raf.a)); break; // AND HL,(HL+A) + case 0x75: reg.hl= op_xor_hl((t_addr)(reg.hl+reg.raf.a)); break; // XOR HL,(HL+A) + case 0x76: reg.hl= op_or_hl((t_addr)(reg.hl+reg.raf.a)); break; // OR HL,(HL+A) + case 0x77: reg.hl= op_sub_hl((t_addr)(reg.hl+reg.raf.a)); break; // CP HL,(HL+A) + case 0x87: inst_inc(cell_hl_a()); break; // INC (HL+A) + case 0x8f: inst_dec(cell_hl_a()); break; // DEC (HL+A) + case 0x97: inst_inc16((t_addr)(reg.hl+reg.raf.a)); break; // INCW (HL+A) + case 0x9f: inst_dec16((t_addr)(reg.hl+reg.raf.a)); break; // DECW (HL+A) + case 0xa0: inst_rlc(cell_hl_a()); break; // RLC (HL+A) + case 0xa1: inst_rrc(cell_hl_a()); break; // RRC (HL+A) + case 0xa2: inst_rl(cell_hl_a()); break; // RL (HL+A) + case 0xa3: inst_rr(cell_hl_a()); break; // RR (HL+A) + case 0xa4: inst_sla(cell_hl_a()); break; // SLA (HL+A) + case 0xa5: inst_sra(cell_hl_a()); break; // SRA (HL+A) + case 0xa6: inst_sla(cell_hl_a()); break; // SLL (HL+A) + case 0xa7: inst_srl(cell_hl_a()); break; // SRL (HL+A) + default: + // handle c1==f3 cases where second byte is not fix + if ((c2 & 0xfc) == 0x14) // ADD ix,(HL+A) + { + u16_t *op1= aof_reg16_ix(c2); + u16_t op2= mem16(reg.hl+reg.raf.a); + vc.rd+= 2; + *op1= op_add16(*op1, op2); + } + else + switch (c2 & 0xf8) + { + case 0x18: // TSET b,(HL+A) + { + cl_memory_cell *c= cell_hl_a(); + u8_t v= c->read(); + vc.rd++; + c->write(op_tset(v, c2)); + vc.wr++; + break; + } + case 0x28: *aof_reg8(c2)= cell_hl_a()->read(); vc.rd++; break; // LD r,(HL+A) + case 0x48: *aof_reg16_rr(c2)= mem16(reg.hl+reg.raf.a); vc.rd+= 2; break; // LD rr,(HL+A) + case 0x50: // EX (HL+A),rr + { + cl_memory_cell *c= cell_hl_a(); + u16_t t= c->read(), *r= aof_reg16_rr(c2); + vc.rd++; + c->write(*r); + vc.wr++; + *r= t; + break; + } + case 0xa8: op_bit(cell_hl_a()->read(), c2); vc.rd++; break; // BIT b,(HL+A) + case 0xb0: // RES b,(HL+A) + { + cl_memory_cell *c= cell_hl_a(); + u8_t v= op_res(c->read(), c2); + vc.rd++; + c->write(v); + vc.wr++; + break; + } + case 0xb8: // SET b,(HL+A) + { + cl_memory_cell *c= cell_hl_a(); + u8_t v= op_set(c->read(), c2); + vc.rd++; + c->write(v); + vc.wr++; + break; + } + default: + res= resINV_INST; + break; + } + break; + } + return res; +} + +/* F7 XX + */ + +int +cl_tlcs::exec_inst2_f7(u8_t c2) +{ + int res= resGO; + u8_t n, m; + + switch (c2) + { + case 0x37: n= fetch(); cell_hl_a()->write(n); vc.wr++; break; // LD (HL+A),n + case 0x3f: n= fetch(); m= fetch(); write16(reg.hl+reg.raf.a, m*256+n); vc.wr+= 2; break; // LDW (HL+A),mn + case 0x68: n= fetch(); cell_hl_a()->write(op_add8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // ADD (HL+A),n + case 0x69: n= fetch(); cell_hl_a()->write(op_adc8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // ADC (HL+A),n + case 0x6a: n= fetch(); cell_hl_a()->write(op_sub8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // SUB (HL+A),n + case 0x6b: n= fetch(); cell_hl_a()->write(op_sbc8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // SBC (HL+A),n + case 0x6c: n= fetch(); cell_hl_a()->write(op_and8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // AND (HL+A),n + case 0x6d: n= fetch(); cell_hl_a()->write(op_xor8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // XOR (HL+A),n + case 0x6e: n= fetch(); cell_hl_a()->write(op_or8(cell_hl_a()->read(), n)); vc.rd++; vc.wr++; break; // OR (HL+A),n + case 0x6f: n= fetch(); op_cp8(cell_hl_a()->read(), n); vc.rd++; break; // CP (HL+A),n + default: + switch (c2 & 0xf0) + { + case 0xc0: if (cc(c2)) PC= reg.hl|reg.raf.a; break; // JP [cc,]HL+A + case 0xd0: if (cc(c2)) inst_call(PC-2, reg.hl+reg.raf.a); break; // CALL [cc,]HL+A + default: + switch (c2 & 0xf8) + { + case 0x20: cell_hl_a()->write(*aof_reg8(c2)); vc.wr++; break; // LD (HL+A),r + case 0x38: *aof_reg16_rr(c2)= reg.hl+reg.raf.a; break; // LDA rr,HL+A + case 0x40: write16(reg.hl+reg.raf.a, *aof_reg16_rr(c2)); vc.wr+= 2; break; // LD (HL+A),rr + default: + res= resINV_INST; + break; + } + break; + } + } + return res; +} + +/* FE XX + */ + +int +cl_tlcs::exec_inst2_fe(u8_t c2) +{ + int res= resGO; + + if ((c2 & 0xf0) == 0xd0) // RET cc + { + if (cc(c2)) inst_ret(); + } + else + switch (c2) + { + case 0x58: ldi(); break; + case 0x59: ldir(); break; + case 0x5a: ldd(); break; + case 0x5b: lddr(); break; + case 0x5c: cpi(); break; + case 0x5d: cpir(); break; + case 0x5e: cpd(); break; + case 0x5f: cpdr(); break; + default: + res= resINV_INST; + break; + } + return res; +} + +/* E0+gg XX + */ + +int +cl_tlcs::exec_inst2_e0gg(u8_t c1, u8_t c2) +{ + int res= resGO; + cl_memory_cell *gg= cell_gg(c1); + + switch (c2) + { + case 0x10: inst_rld(gg); break; // RLD (gg) + case 0x11: inst_rrd(gg); break; // RRD (gg) + case 0x12: inst_mul_hl(gg); break; // MUL HL,(gg) + case 0x13: inst_div_hl(gg); break; // DIV HL,(gg) + case 0x60: inst_add_a(gg); break; // ADD A,(gg) + case 0x61: inst_adc_a(gg); break; // ADC A,(gg) + case 0x62: inst_sub_a(gg); break; // SUB,A(gg) + case 0x63: inst_sbc_a(gg); break; // SBC A,(gg) + case 0x64: inst_and_a(gg); break; // AND A(gg) + case 0x65: inst_xor_a(gg); break; // XOR A(gg) + case 0x66: inst_or_a(gg); break; // OR A,(gg) + case 0x67: op_cp_a(gg); break; // CP A,(gg) + case 0x70: reg.hl= op_add_hl((t_addr)*aof_reg16_gg(c1)); break; // ADD HL,(gg) + case 0x71: reg.hl= op_adc_hl((t_addr)*aof_reg16_gg(c1)); break; // ADC HL,(gg) + case 0x72: reg.hl= op_sub_hl((t_addr)*aof_reg16_gg(c1)); break; // SUB HL,(gg) + case 0x73: reg.hl= op_sbc_hl((t_addr)*aof_reg16_gg(c1)); break; // SBC HL,(gg) + case 0x74: reg.hl= op_and_hl((t_addr)*aof_reg16_gg(c1)); break; // AND HL,(gg) + case 0x75: reg.hl= op_xor_hl((t_addr)*aof_reg16_gg(c1)); break; // XOR HL,(gg) + case 0x76: reg.hl= op_or_hl((t_addr)*aof_reg16_gg(c1)); break; // OR HL,(gg) + case 0x77: reg.hl= op_sub_hl((t_addr)*aof_reg16_gg(c1)); break; // CP HL,(gg) + case 0x87: inst_inc(gg); break; // INC (gg) + case 0x8f: inst_dec(gg); break; // DEC (gg) + case 0x97: inst_inc16gg(c1, *aof_reg16_gg(c1)); break; // INCW (gg) + case 0x9f: inst_dec16gg(c1, *aof_reg16_gg(c1)); break; // DECW (gg) + case 0xa0: inst_rlc(gg); break; // RLC (gg) + case 0xa1: inst_rrc(gg); break; // RRC (gg) + case 0xa2: inst_rl(gg); break; // RL (gg) + case 0xa3: inst_rr(gg); break; // RR (gg) + case 0xa4: inst_sla(gg); break; // SLA (gg) + case 0xa5: inst_sra(gg); break; // SRA (gg) + case 0xa6: inst_sla(gg); break; // SLL (gg) + case 0xa7: inst_srl(gg); break; // SRL (gg) + default: + if ((c2 & 0xfc) == 0x14) // ADD ix,(gg) + { + u16_t *ix= aof_reg16_ix(c2); + *ix= op_add16(*ix, mem16gg(c1)); + } + else + switch (c2 & 0xf8) + { + case 0x18: inst_tset(gg, c2); break; // TSET b,(gg) + case 0x28: *aof_reg8(c2)= gg->read(); vc.rd++; break; // LD r,(gg) + case 0x48: *aof_reg16_rr(c2)= mem16gg(c1); vc.rd+= 2; break; // LD rr,(gg) + case 0x50: // EX (gg),rr + { + u16_t *ra= aof_reg16_rr(c2); + u16_t r= *ra; + *ra= mem16gg(c1); + vc.rd+= 2; + write16gg(c1, r); + vc.wr+= 2; + break; + } + case 0xa8: inst_bit(gg, c2); break; // BIT b,(gg) + case 0xb0: inst_res(gg, c2); break; // RES b,(gg) + case 0xb8: inst_set(gg, c2); break; // SET b,(gg) + default: + res= resINV_INST; + break; + } + } + + return res; +} + +/* E8+gg XX + */ + +int +cl_tlcs::exec_inst2_e8gg(u8_t c1, u8_t c2) +{ + int res= resGO; + class cl_memory_cell *gg= cell_gg(c1); + t_addr gv= *aof_reg16_gg(c1); + u8_t n, m; + + switch (c2) + { + case 0x37: n= fetch(); gg->write(n); vc.wr++; break; // LD (gg),n + case 0x3F: n= fetch(); m= fetch(); write16gg(c1, m*256+n); vc.wr+= 2; break; // LDW (gg),mn + case 0x68: n= fetch(); gg->write(op_add8(gg->read(), n)); vc.rd++; vc.wr++; break; // ADD (gg),n + case 0x69: n= fetch(); gg->write(op_adc8(gg->read(), n)); vc.rd++; vc.wr++; break; // ADC (gg),n + case 0x6a: n= fetch(); gg->write(op_sub8(gg->read(), n)); vc.rd++; vc.wr++; break; // SUB (gg),n + case 0x6b: n= fetch(); gg->write(op_sbc8(gg->read(), n)); vc.rd++; vc.wr++; break; // SBC (gg),n + case 0x6c: n= fetch(); gg->write(op_and8(gg->read(), n)); vc.rd++; vc.wr++; break; // AND (gg),n + case 0x6d: n= fetch(); gg->write(op_xor8(gg->read(), n)); vc.rd++; vc.wr++; break; // XOR (gg),n + case 0x6e: n= fetch(); gg->write(op_or8(gg->read(), n)); vc.rd++; vc.wr++; break; // OR (gg),n + case 0x6f: n= fetch(); op_cp8(gg->read(), n); vc.rd++; break; // CP (gg),n + default: + switch (c2 & 0xf0) + { + case 0xc0: if (cc(c2)) PC= gv; break; // JP [cc,]gg + case 0xd0: if (cc(c2)) inst_call(PC-2, gv); break; // CALL [cc,]gg + default: + switch (c2 & 0xf8) + { + case 0x20: gg->write(*aof_reg8(c2)); vc.wr++; break; // LD (gg),r + case 0x40: write16gg(c1, *aof_reg16_rr(c2)); vc.wr+= 2; break; // LD (gg),rr + default: + res= resINV_INST; + break; + } + break; + } + break; + } + return res; +} + +/* F8+g XX, F8+gg XX + */ + +int +cl_tlcs::exec_inst2_f8gg(u8_t c1, u8_t c2) +{ + int res= resGO; + u8_t *ga= aof_reg8(c1), n; + u16_t *gga= aof_reg16_gg(c1); + + if ((c1 == 0xfe) && + ( + ((c2>=0x58)&&(c2<=0x5f)) || + ((c2&0xf0)==0xd0) + ) + ) + res= exec_inst2_fe(c2); + else + { + switch (c2) + { + case 0x12: reg.hl= reg.rhl.l * (*ga); break; // MUL HL,g + case 0x13: inst_div_hl(*ga); break; // DIV HL,g + case 0x60: reg.raf.a= op_add_a(*ga); break; // ADD A,g + case 0x61: inst_adc_a(*ga); break; // ADC A,g + case 0x62: inst_sub_a(*ga); break; // SUB A,g + case 0x63: inst_sbc_a(*ga); break; // SBC A,g + case 0x64: inst_and_a(*ga); break; // AND A,g + case 0x65: inst_xor_a(*ga); break; // XOR A,g + case 0x66: inst_or_a(*ga); break; // OR A,g + case 0x67: op_cp_a(*ga); break; // CP A,g + case 0x70: reg.hl= op_add_hl((t_mem)*gga); break; // ADD HL,gg + case 0x71: reg.hl= op_adc_hl((t_mem)*gga); break; // ADC HL,gg + case 0x72: reg.hl= op_sub_hl((t_mem)*gga); break; // SUB HL,gg + case 0x73: reg.hl= op_sbc_hl((t_mem)*gga); break; // SBC HL,gg + case 0x74: reg.hl= op_and_hl((t_mem)*gga); break; // AND HL,gg + case 0x75: reg.hl= op_xor_hl((t_mem)*gga); break; // XOR HL,gg + case 0x76: reg.hl= op_or_hl((t_mem)*gga); break; // OR HL,gg + case 0x77: op_sub_hl((t_mem)*gga); break; // CP HL,gg + case 0xA0: *ga= op_rlc(*ga, true); break; // RLC g + case 0xA1: *ga= op_rrc(*ga, true); break; // RRC g + case 0xA2: *ga= op_rl(*ga, true); break; // RL g + case 0xA3: *ga= op_rr(*ga, true); break; // RR g + case 0xA4: *ga= op_sla(*ga, true); break; // SLA g + case 0xA5: *ga= op_sra(*ga, true); break; // SRA g + case 0xA6: *ga= op_sla(*ga, true); break; // SLL g + case 0xA7: *ga= op_srl(*ga, true); break; // SRL g + // some 3 byte cases + case 0x68: n= fetch(); *ga= op_add8(*ga, n); break; // ADD g,n + case 0x69: n= fetch(); *ga= op_adc8(*ga, n); break; // ADC g,n + case 0x6a: n= fetch(); *ga= op_sub8(*ga, n); break; // SUB g,n + case 0x6b: n= fetch(); *ga= op_sbc8(*ga, n); break; // SBC g,n + case 0x6c: n= fetch(); *ga= op_and8(*ga, n); break; // AND g,n + case 0x6d: n= fetch(); *ga= op_xor8(*ga, n); break; // XOR g,n + case 0x6e: n= fetch(); *ga= op_or8(*ga, n); break; // OR g,n + case 0x6f: n= fetch(); *ga= op_cp8(*ga, n); break; // CP g,n + // non-fix 2nd byte cases + default: + if ((c2 & 0xfc) == 0x14) // ADD ix,gg + *aof_reg16_ix(c2)= op_add16(*aof_reg16_ix(c2), *gga); + else + switch (c2 & 0xf8) + { + case 0x18: *ga= op_tset(*ga, c2); break; // TSET b,g + case 0x30: *aof_reg8(c2)= *ga; break; // LD r,g + case 0x38: *aof_reg16_rr(c2)= *gga; break; // LD rr,gg + case 0xa8: *ga= op_bit(*ga, c2); break; // BIT b,g + case 0xb0: *ga= op_res(*ga, c2); break; // RES b,g + case 0xb8: *ga= op_set(*ga, c2); break; // SET b,g + default: + res= resINV_INST; + break; + } + break; + } + } + + return res; +} + +/* + */ + +int +cl_tlcs::exec_inst3(u8_t c1, u8_t c2) +{ + int res= resGO; + u8_t c3= fetch(); + + switch (c1) + { + case 0x1a: PC= c3*256 + c2; break; // JP mn + case 0x1b: PC+= i16_t(c3*256 + c2); break; // JRL $+2+cd + case 0x1c: inst_call(PC-3, c3*256 + c2); break; // CALL mn + case 0x1d: inst_call(PC-3, PC + i16_t(c3*256 + c2)); break; // CALR $+2+cd + case 0x78: reg.hl= op_add_hl((t_mem)(c3*256+c2)); break; // ADD HL,mn + case 0x79: reg.hl= op_adc_hl((t_mem)(c3*256+c2)); break; // ADC HL,mn + case 0x7a: reg.hl= op_sub_hl((t_mem)(c3*256+c2)); break; // SUB HL,mn + case 0x7b: reg.hl= op_sbc_hl((t_mem)(c3*256+c2)); break; // SBC HL,mn + case 0x7c: reg.hl= op_and_hl((t_mem)(c3*256+c2)); break; // AND HL,mn + case 0x7d: reg.hl= op_xor_hl((t_mem)(c3*256+c2)); break; // XOR HL,mn + case 0x7e: reg.hl= op_or_hl((t_mem)(c3*256+c2)); break; // OR HL,mn + case 0x7f: op_sub_hl((t_mem)(c3*256+c2)); break; // CP HL,mn + default: + switch (c1 & 0xf8) + { + case 0x38: *aof_reg16_rr(c1)= c3*256 + c2; break; // LD rr,mn + default: + res= resINV_INST; + break; + } + break; + } + + return res; +} + +/* E7 n XX + */ + +int +cl_tlcs::exec_inst3_e7(u8_t c1, u8_t c2, u8_t c3) +{ + int res= resGO; + cl_memory_cell *n= cell_n(c2); + + switch (c3) + { + case 0x10: inst_rld(n); break; // RLD (0ffn) + case 0x11: inst_rrd(n); break; // RRD (0ffn) + case 0x12: inst_mul_hl(n); break; // MUL HL,(0ffn) + case 0x13: inst_div_hl(n); break; // DIV HL,(0ffn) + case 0xa0: inst_rlc(n); break; // RLC (0ffn) + case 0xa1: inst_rrc(n); break; // RRC (0ffn) + case 0xa2: inst_rl(n); break; // RL (0ffn) + case 0xa3: inst_rr(n); break; // RR (0ffn) + case 0xa4: inst_sla(n); break; // SLA (0ffn) + case 0xa5: inst_sra(n); break; // SRA (0ffn) + case 0xa6: inst_sla(n); break; // SLL (0ffn) + case 0xa7: inst_srl(n); break; // SRL (0ffn) + default: + if ((c3 & 0xfc) == 0x14) // ADD ix,(0ffn) + { + u16_t *aix= aof_reg16_ix(c3); + *aix= op_add16(*aix, mem16(0xff00 + c2)); + vc.rd+= 2; + } + else + switch (c3 & 0xf8) + { + case 0x18: inst_tset(n, c3); break; // TSET b,(0ffn) + case 0x28: *aof_reg8(c3)= n->read(); vc.rd++; break; // LD r,(0ffn) + case 0x48: *aof_reg16_rr(c3)= mem16(0xff00 + c2); vc.rd+= 2; break; // LD rr,(0ffn); + case 0x50: // EX (0ffn),rr + { + u16_t temp= mem16(0xff00+c2); + vc.rd+= 2; + u16_t *ar= aof_reg16_rr(c3); + write16(0xff00+c2, *ar); + vc.wr+= 2; + *ar= temp; + break; + } + default: + res= resINV_INST; + break; + } + } + + return res; +} + +/* + */ + +int +cl_tlcs::exec_inst3_f0ix(u8_t c1) +{ + i8_t d= fetch(); + u8_t c3= fetch(); + int res= resGO; + cl_memory_cell *c= cell_ixd(c1, d); + u16_t a= *aof_reg16_ix(c1)+d; + + switch (c3) + { + case 0x10: inst_rld(c); break; // RLD (ix+d) + case 0x11: inst_rrd(c); break; // RRD (ix+d) + case 0x12: inst_mul_hl(c); break; // MUL HL,(ix+d) + case 0x13: inst_div_hl(c); break; // DIV HL,(ix+d) + case 0x60: inst_add_a(c); break; // ADD A,(ix+d) + case 0x61: inst_adc_a(c); break; // ADC A,(ix+d) + case 0x62: inst_sub_a(c); break; // SUB A,(ix+d) + case 0x63: inst_sbc_a(c); break; // SBC A,(ix+d) + case 0x64: inst_and_a(c); break; // AND A,(ix+d) + case 0x65: inst_xor_a(c); break; // XOR A,(ix+d) + case 0x66: inst_or_a(c); break; // OR A,(ix+d) + case 0x67: op_cp_a(c); break; // CP A,(ix+d) + case 0x70: reg.hl= op_add_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // ADD HL,(ix+d) + case 0x71: reg.hl= op_adc_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // ADC HL,(ix+d) + case 0x72: reg.hl= op_sub_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // SUB HL,(ix+d) + case 0x73: reg.hl= op_sbc_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // SBC HL,(ix+d) + case 0x74: reg.hl= op_and_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // AND HL,(ix+d) + case 0x75: reg.hl= op_xor_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // XOR HL,(ix+d) + case 0x76: reg.hl= op_or_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // OR HL,(ix+d) + case 0x77: op_sub_hl((t_mem)mem16ixd(c1,d)); vc.rd+= 2; break; // CP HL,(ix+d) + case 0x87: inst_inc(c); break; // INC (ix+d) + case 0x8F: inst_dec(c); break; // DEC (ix+d) + case 0x97: inst_inc16ix(c1, a); break; // INCW (ix+d) + case 0x9F: inst_dec16ix(c1, a); break; // DECW (ix+d) + case 0xA0: inst_rlc(c); break; // RLC (ix+d) + case 0xA1: inst_rrc(c); break; // RRC (ix+d) + case 0xA2: inst_rl(c); break; // RL (ix+d) + case 0xA3: inst_rr(c); break; // RR (ix+d) + case 0xA4: inst_sla(c); break; // SLA (ix+d) + case 0xA5: inst_sra(c); break; // SRA (ix+d) + case 0xA6: inst_sla(c); break; // SLL (ix+d) + case 0xA7: inst_srl(c); break; // SRL (ix+d) + default: + if ((c3 & 0xfc) == 0x14) // ADD ix,(jx+d) + { + u16_t *rp= aof_reg16_ix(c3); + u16_t op= mem16ixd(c1, d); + vc.rd+= 2; + *rp= op_add16(*rp, op); + } + else + switch (c3 & 0xf8) + { + case 0x18: inst_tset(c, c3); break; // TSET b,(ix+d) + case 0x28: *aof_reg8(c3)= c->read(); vc.rd++; break; // LD r,(ix+d) + case 0x48: *aof_reg16_rr(c3)= mem16ixd(c1, d); vc.rd+= 2; break; // LD rr,(ix+d) + case 0x50: // EX (ix+d),rr + { + u16_t temp= mem16ixd(c1, d); + vc.rd+= 2; + u16_t *ra= aof_reg16_rr(c3); + write16ixd(c1, d, *ra); + vc.wr+= 2; + *ra= temp; + break; + } + case 0xa8: inst_bit(c, c3); break; // BIT b,(ix+d) + case 0xb0: inst_res(c, c3); break; // RES b,(ix+d) + case 0xb8: inst_set(c, c3); break; // SET b,(ix+d) + default: + res= resINV_INST; + break; + } + } + + return res; +} + +/* E3 n m XX + */ + +int +cl_tlcs::exec_inst4_e3(u8_t c1, u8_t c2, u8_t c3, u8_t c4) +{ + int res= resGO; + u16_t mn= c3 * 256 + c2; + class cl_memory_cell *c= nas->get_cell(mn); + + switch (c4) + { + case 0x10: inst_rld(c); break; // RLD (mn) + case 0x11: inst_rrd(c); break; // RRD (mn) + case 0x12: inst_mul_hl(c); break; // MUL HL,(mn) + case 0x13: inst_div_hl(c); break; // DIV HL,(mn) + case 0x60: inst_add_a(c); break; // ADD A,(mn) + case 0x61: inst_sbc_a(c); break; // ADC A,(mn) + case 0x62: inst_sub_a(c); break; // SUB A,(mn) + case 0x63: inst_sbc_a(c); break; // SBC A,(mn) + case 0x64: inst_and_a(c); break; // AND A,(mn) + case 0x65: inst_xor_a(c); break; // XOR A,(mn) + case 0x66: inst_or_a(c); break; // OR A,(mn) + case 0x67: op_cp_a(c); break; // CP A,(mn) + case 0x70: reg.hl= op_add_hl((t_addr)mn); break; // ADD HL,(mn) + case 0x71: reg.hl= op_adc_hl((t_addr)mn); break; // ADC HL,(mn) + case 0x72: reg.hl= op_sub_hl((t_addr)mn); break; // SUB HL,(mn) + case 0x73: reg.hl= op_sbc_hl((t_addr)mn); break; // SBC HL,(mn) + case 0x74: reg.hl= op_and_hl((t_addr)mn); break; // AND HL,(mn) + case 0x75: reg.hl= op_xor_hl((t_addr)mn); break; // XOR HL,(mn) + case 0x76: reg.hl= op_or_hl((t_addr)mn); break; // OR HL,(mn) + case 0x77: op_sub_hl((t_addr)mn); break; // CP HL,(mn) + case 0x87: inst_inc(c); break; // INC (mn) + case 0x8f: inst_dec(c); break; // DEC (mn) + case 0x97: inst_inc16((t_addr)mn); break; // INCW (mn) + case 0x9f: inst_dec16((t_addr)mn); break; // DECW (mn) + case 0xa0: inst_rlc(c); break; // RLC (mn) + case 0xa1: inst_rrc(c); break; // RRC (mn) + case 0xa2: inst_rl(c); break; // RL (mn) + case 0xa3: inst_rr(c); break; // RR (mn) + case 0xa4: inst_sla(c); break; // SLA (mn) + case 0xa5: inst_sra(c); break; // SRA (mn) + case 0xa6: inst_sla(c); break; // SLL (mn) + case 0xa7: inst_srl(c); break; // SRL (mn) + default: + if ((c4 & 0xfc) == 0x14) // ADD ix,(mn) + *aof_reg16_ix(c4)= op_add16(*aof_reg16_ix(c4), mem16(mn)); + else + switch (c4 & 0xf8) + { + case 0x18: inst_tset(c, c4); break;; // TSET b,(mn) + case 0x28: *aof_reg8(c4)= c->read(); vc.rd++; break; // LD r,(mn) + case 0x48: *aof_reg16_rr(c4)= mem16(mn); vc.rd+= 2; break; // LD rr,(mn) + case 0x50: // EX (mn),rr + { + u16_t temp= mem16(mn); + vc.rd+= 2; + u16_t *ar= aof_reg16_rr(c4); + write16(mn, *ar); + vc.wr+= 2; + *ar= temp; + } + case 0xa8: inst_bit(c, c4); break; // BIT b,(mn) + case 0xb0: inst_res(c, c4); break; // RES b,(mn) + case 0xb8: inst_set(c, c4); break; // SET b,(mn) + default: + res= resINV_INST; + break; + } + } + + return res; +} + +/* EF n|w X n + */ + +int +cl_tlcs::exec_inst4_ef(u8_t c1, u8_t c2, u8_t c3) +{ + int res= resGO; + u8_t n; + cl_memory_cell *wc= cell_n(c2); + u8_t wd= wc->read(); + + switch (c3) + { + case 0x68: n= fetch(); wc->write(op_add8(wd, n)); vc.wr++; break; // ADD (0ffw),n + case 0x69: n= fetch(); wc->write(op_adc8(wd, n)); vc.wr++; break; // ADC (0ffw),n + case 0x6a: n= fetch(); wc->write(op_sub8(wd, n)); vc.wr++; break; // SUB (0ffw),n + case 0x6b: n= fetch(); wc->write(op_sbc8(wd, n)); vc.wr++; break; // SBC (0ffw),n + case 0x6c: n= fetch(); wc->write(op_and8(wd, n)); vc.wr++; break; // AND (0ffw),n + case 0x6d: n= fetch(); wc->write(op_xor8(wd, n)); vc.wr++; break; // XOR (0ffw),n + case 0x6e: n= fetch(); wc->write(op_or8(wd, n)); vc.wr++; break; // OR (0ffw),n + case 0x6f: n= fetch(); op_cp8(wd, n); break; // CP (0ffw),n + default: + switch (c3 & 0xf8) // EF n XX+r + { + case 0x20: wc->write(*aof_reg8(c3)); vc.wr++; break; // LD (0ffn),r + case 0x40: write16(0xff00+c2, *aof_reg16_rr(c3)); vc.wr+= 2; break; // LD (0ffn),rr + default: + res= resINV_INST; + break; + } + break; + } + + return res; +} + +/* EB n|w m|v XX [n [m]] + */ + +int +cl_tlcs::exec_inst4_eb(u8_t c1, u8_t c2, u8_t c3, u8_t c4) +{ + int res= resGO; + u16_t nm23= c3*256 + c2; + u16_t vw23= nm23; + u8_t n5; + class cl_memory_cell *c= nas->get_cell(vw23); + + switch (c4) + { + case 0x37: n5= fetch(); c->write(n5); vc.wr++; break; // LD (vw),n + case 0x3f: n5= fetch(); write16(vw23, n5 + fetch()*256); vc.wr+= 2; break; // LDW (vw),mn + case 0x68: n5= fetch(); c->write(op_add8(c->read(), n5)); vc.wr++; break; // ADD (vw),n + case 0x69: n5= fetch(); c->write(op_adc8(c->read(), n5)); vc.wr++; break; // ADC (vw),n + case 0x6a: n5= fetch(); c->write(op_sub8(c->read(), n5)); vc.wr++; break; // SUB (vw),n + case 0x6b: n5= fetch(); c->write(op_sbc8(c->read(), n5)); vc.wr++; break; // SBC (vw),n + case 0x6c: n5= fetch(); c->write(op_and8(c->read(), n5)); vc.wr++; break; // AND (vw),n + case 0x6d: n5= fetch(); c->write(op_xor8(c->read(), n5)); vc.wr++; break; // XOR (vw),n + case 0x6e: n5= fetch(); c->write(op_or8(c->read(), n5)); vc.wr++; break; // OR (vw),n + case 0x6f: n5= fetch(); op_cp8(c->read(), n5); vc.rd++; break; // CP (vw),n + default: + switch (c4 & 0xf8) + { + case 0x20: c->write(*aof_reg8(c4)); vc.wr++; break; // LD (mn),r + case 0x40: write16(vw23, *aof_reg16_rr(c4)); vc.wr+= 2; break; // LD (mn),rr + default: + switch (c4 & 0xf0) + { + case 0xc0: if (cc(c4)) PC= vw23; break; // JP cc,mn + case 0xd0: if (cc(c4)) inst_call(PC-4, vw23); break; // CALL cc,mn + default: + res= resINV_INST; + break; + } + break; + } + break; + } + + return res; +} + +/* F4+ix d XX [n [m]] + */ + +int +cl_tlcs::exec_inst4_f4ix(u8_t c1, u8_t c2, u8_t c3) +{ + int res= resGO; + i8_t d= c2; + u8_t n; + cl_memory_cell *c= cell_ixd(c1, d); + + switch (c3) + { + case 0x37: n= fetch(); c->write(n); vc.wr++; break; // LD (ix+d),n + case 0x3f: n= fetch(); write16ixd(c1, d, n+fetch()*256); vc.wr+= 2; break; // LDW (ix+d),mn + case 0x68: n= fetch(); c->write(op_add8(c->read(), n)); vc.rd++; vc.wr++; break; // ADD (ix+d),n + case 0x69: n= fetch(); c->write(op_adc8(c->read(), n)); vc.rd++; vc.wr++; break; // ADC (ix+d),n + case 0x6a: n= fetch(); c->write(op_sub8(c->read(), n)); vc.rd++; vc.wr++; break; // SUB (ix+d),n + case 0x6b: n= fetch(); c->write(op_sbc8(c->read(), n)); vc.rd++; vc.wr++; break; // SBC (ix+d),n + case 0x6c: n= fetch(); c->write(op_and8(c->read(), n)); vc.rd++; vc.wr++; break; // AND (ix+d),n + case 0x6d: n= fetch(); c->write(op_xor8(c->read(), n)); vc.rd++; vc.wr++; break; // XOR (ix+d),n + case 0x6e: n= fetch(); c->write(op_or8(c->read(), n)); vc.rd++; vc.wr++; break; // OR (ix+d),n + case 0x6f: n= fetch(); op_cp8(c->read(), n); vc.rd++; break; // CP (ix+d),n + default: + switch (c3 & 0xf0) + { + case 0xc0: if (cc(c3)) PC= *aof_reg16_ix(c1)+d; break; // JP [cc,]ix+d + case 0xd0: if (cc(c3)) inst_call(PC-4, *aof_reg16_ix(c1)+d); break; // CALL [cc,]ix+d + default: + switch (c3 & 0xf8) + { + case 0x20: c->write(*aof_reg8(c3)); vc.wr++; break; // LD (ix+d),r + case 0x38: *aof_reg16_rr(c3)= *aof_reg16_ix(c1)+d; break; // LDA rr,ix+d + case 0x40: write16ixd(c1, d, *aof_reg16_rr(c3)); vc.wr+= 2; break; // LD (ix+d),rr + default: + res= resINV_INST; + break; + } + break; + } + break; + } + + return res; +} + + +t_addr +cl_tlcs::do_push(t_mem data) +{ + t_addr sp_before= reg.sp; + reg.sp-= 1; + nas->write(reg.sp, (data>>8)&0xff); + reg.sp-= 1; + nas->write(reg.sp, (data&0xff)); + vc.wr+= 2; + return sp_before; +} + +t_addr +cl_tlcs::do_pop(t_mem *data) +{ + t_addr sp_before= reg.sp; + t_mem val; + val= nas->read(reg.sp); + reg.sp+= 1; + val= (nas->read(reg.sp) * 256) + val; + reg.sp+= 1; + if (data) + *data= val; + vc.rd+= 2; + return sp_before; +} + +int +cl_tlcs::exec_push(t_addr PC_of_inst, t_mem data) +{ + t_addr sp_before= do_push(data); + class cl_stack_push *o= new cl_stack_push(PC_of_inst, data, sp_before, reg.sp); + o->init(); + stack_write(o); + return resGO; +} + +int +cl_tlcs::exec_ret(t_addr PC_of_inst, t_mem *data) +{ + t_addr sp_before= do_pop(data); + t_mem val= 0; + if (data) + val= *data; + class cl_stack_ret *o= new cl_stack_ret(PC_of_inst, val, sp_before, reg.sp); + o->init(); + stack_read(o); + return resGO; +} + +int +cl_tlcs::exec_reti(t_addr PC_of_inst, t_mem *data) +{ + t_addr sp_before= do_pop(data); + t_mem val= 0; + if (data) + val= *data; + class cl_stack_iret *o= new cl_stack_iret(PC_of_inst, val, sp_before, reg.sp); + o->init(); + stack_read(o); + return resGO; +} + +int +cl_tlcs::exec_pop(t_addr PC_of_inst, t_mem *data) +{ + t_addr sp_before= do_pop(data); + t_mem val= 0; + if (data) + val= *data; + class cl_stack_pop *o= new cl_stack_pop(PC_of_inst, val, sp_before, reg.sp); + o->init(); + stack_read(o); + return resGO; +} + +int +cl_tlcs::exec_intr(t_addr PC_of_inst, t_addr called, t_mem data) +{ + t_addr sp_before= do_push(data); + class cl_stack_intr *o= new cl_stack_intr(PC_of_inst, called, data, sp_before, reg.sp); + o->init(); + stack_write(o); + return resGO; +} + +int +cl_tlcs::exec_call(t_addr PC_of_inst, t_addr called, t_mem data) +{ + t_addr sp_before= do_push(data); + class cl_stack_call *o= new cl_stack_call(PC_of_inst, called, data, sp_before, reg.sp); + o->init(); + stack_write(o); + return resGO; +} + +void +cl_tlcs::set_p(u8_t data) +{ + // P=1 means EVEN + int b= 0, i; + + for (i= 0; i < 8; i++) + { + if (data & 1) + b++; + data>>= 1; + } + if (b&1) + // ODD, P <- 0 + reg.raf.f&= ~FLAG_V; + else + // EVEN, P <- 1 + reg.raf.f|= FLAG_V; +} + +u8_t * +cl_tlcs::aof_reg8(u8_t data_r) +{ + switch (data_r & 0x07) + { + case 0: return ®.rbc.b; + case 1: return ®.rbc.c; + case 2: return ®.rde.d; + case 3: return ®.rde.e; + case 4: return ®.rhl.h; + case 5: return ®.rhl.l; + case 6: return ®.raf.a; + default: return ®.dummy; + } +} + +u16_t * +cl_tlcs::aof_reg16_rr(u8_t data_rr) +{ + switch (data_rr & 0x07) + { + case 0: return ®.bc; + case 1: return ®.de; + case 2: return ®.hl; + case 4: return ®.ix; + case 5: return ®.iy; + case 6: return ®.sp; + default: return ®.dummy16; + } +} + +u16_t * +cl_tlcs::aof_reg16_qq(u8_t data_qq) +{ + switch (data_qq & 0x07) + { + case 0: return ®.bc; + case 1: return ®.de; + case 2: return ®.hl; + case 4: return ®.ix; + case 5: return ®.iy; + case 6: return ®.af; + default: return ®.dummy16; + } +} + +u16_t * +cl_tlcs::aof_reg16_ix(u8_t data_ix) +{ + switch (data_ix & 0x03) + { + case 0: return ®.ix; + case 1: return ®.iy; + case 2: return ®.sp; + default: return ®.dummy16; + } +} + +u16_t * +cl_tlcs::aof_reg16_gg(u8_t data_gg) +{ + return aof_reg16_rr(data_gg); +} + +class cl_memory_cell * +cl_tlcs::cell_hl_a() +{ + return nas->get_cell(reg.hl + reg.raf.a); +} + +class cl_memory_cell * +cl_tlcs::cell_gg(u8_t gg) +{ + if ((gg & 0x7) == 4) + return xas->get_cell(*aof_reg16_gg(gg)); + if ((gg & 0x7) == 5) + return yas->get_cell(*aof_reg16_gg(gg)); + return nas->get_cell(*aof_reg16_gg(gg)); +} + +class cl_memory_cell * +cl_tlcs::cell_n(u8_t n) +{ + return nas->get_cell(0xff00 + n); +} + +class cl_memory_cell * +cl_tlcs::cell_ixd(u8_t ix, i8_t d) +{ + switch (ix & 0x03) + { + case 0: return xas->get_cell(reg.ix + d); break; + case 1: return yas->get_cell(reg.iy + d); break; + case 2: return nas->get_cell(reg.sp + d); break; + } + return nas->dummy; +} + +u16_t +cl_tlcs::mem16(t_addr addr) +{ + u8_t l, h; + + l= nas->read(addr); + h= nas->read(addr+1); + + return h*256 + l; +} + +u16_t +cl_tlcs::mem16gg(u8_t gg) +{ + u8_t l, h; + cl_address_space *as= nas; + u16_t addr= *aof_reg16_gg(gg); + + if ((gg & 7) == 4) + as= xas; + if ((gg & 7) == 5) + as= yas; + + l= as->read(addr); + h= as->read(addr+1); + + return h*256 + l; +} + +u16_t +cl_tlcs::mem16ixd(u8_t ix, i8_t d) +{ + u8_t l, h; + cl_address_space *as= nas; + u16_t addr= *aof_reg16_ix(ix) + d; + + if ((ix&3) == 0) + as= xas; + if ((ix&3) == 1) + as= yas; + + l= as->read(addr); + h= as->read(addr+1); + + return h*256 + l; +} + +void +cl_tlcs::write16(t_addr addr, u16_t val) +{ + nas->write(addr, val & 0xff); + nas->write(addr+1, val / 256); +} + + +void +cl_tlcs::write16gg(u8_t gg, u16_t val) +{ + cl_address_space *as= nas; + u16_t addr= *aof_reg16_gg(gg); + + if ((gg&7) == 4) + as = xas; + if ((gg&7) == 5) + as= yas; + as->write(addr, val & 0xff); + as->write(addr+1, val / 256); +} + + +void +cl_tlcs::write16ixd(u8_t ix, i8_t d, u16_t val) +{ + cl_address_space *as= nas; + u16_t addr= *aof_reg16_ix(ix) + d; + + if ((ix&3) == 0) + as = xas; + if ((ix&3) == 1) + as= yas; + as->write(addr, val & 0xff); + as->write(addr+1, val / 256); +} + + +bool +cl_tlcs::flag(enum tlcs_flags f) +{ + return (reg.raf.f & f)?true:false; +} + +bool +cl_tlcs::cc(u8_t cc) +{ + bool s= flag(FLAG_S); + bool v= flag(FLAG_V); + switch (cc & 0x0f) + { + case 0: return false; + case 1: return (s && !v) || (!s && v); + case 2: return flag(FLAG_Z) || ((s && !v) || (!s && v)); + case 3: return flag(FLAG_C) || flag(FLAG_Z); + case 4: return v; + case 5: return s; + case 6: return reg.raf.f & FLAG_Z; + case 7: return reg.raf.f & FLAG_C; + case 8: return true; + case 9: return !((s && !v) || (!s && v)); + case 10: return !(flag(FLAG_Z) || ((s && !v) || (!s && v))); + case 11: return !(flag(FLAG_C) || flag(FLAG_Z)); + case 12: return !v; + case 13: return !s; + case 14: return !(reg.raf.f & FLAG_Z); + case 15: return !(reg.raf.f & FLAG_C); + } + return false; +} + + +/* End of tlcs.src/tlcs.cc */ |
