#include <snes.hpp>

#define SMP_CPP
namespace SNES {

#if defined(DEBUGGER)
  #include "debugger/debugger.cpp"
  SMPDebugger smp;
#else
  SMP smp;
#endif

#include "serialization.cpp"
#include "iplrom.cpp"
#include "memory/memory.cpp"
#include "mmio/mmio.cpp"
#include "timing/timing.cpp"

void SMP::step(unsigned clocks) {
  clock += clocks * (uint64)cpu.frequency;
  dsp.clock -= clocks;
}

void SMP::synchronize_cpu() {
  if(CPU::Threaded == true) {
    if(clock >= 0) scheduler.resume(cpu.thread);
  } else {
    while(clock >= 0) cpu.enter();
  }
}

void SMP::synchronize_dsp() {
  if(DSP::Threaded == true) {
    if(dsp.clock < 0) scheduler.resume(dsp.thread);
  } else {
    while(dsp.clock < 0) dsp.enter();
  }
}

void SMP::Enter() { smp.enter(); }

void SMP::enter() {
  while(true) {
    scheduler.synchronize();
    op_step();
  }
}

void SMP::op_step() {
  if(regs.wait)
    op_wait();
  else
    (this->*opcode_table[op_readpc()])();
}

void SMP::power() {
  //targets not initialized/changed upon reset
  t0.target = 0;
  t1.target = 0;
  t2.target = 0;

  reset();
}

void SMP::reset() {
  create(Enter, system.apu_frequency());

  regs.pc = 0xffc0;
  regs.a = 0x00;
  regs.x = 0x00;
  regs.y = 0x00;
  regs.sp = 0xef;
  regs.p = 0x02;
  regs.wait = false;

  for(unsigned i = 0; i < memory::apuram.size(); i++) {
    memory::apuram.write(i, random(0));
  }

  //$00f0
  status.internal_speed = 0;
  status.external_speed = 0;
  status.timers_enabled = true;
  status.ram_disabled = false;
  status.ram_writable = true;
  status.timers_disabled = false;

  //$00f1
  status.iplrom_enabled = true;

  //$00f2
  status.dsp_addr = 0x00;

  //$00f4-$00f7
  for(unsigned i = 0; i < 4; i++) {
    port.cpu_to_smp[i] = 0;
    port.smp_to_cpu[i] = 0;
  }

  //$00f8-$00f9
  for(unsigned i = 0; i < 2; i++) {
    port.aux[i] = 0;
  }

  t0.stage0_ticks = 0;
  t1.stage0_ticks = 0;
  t2.stage0_ticks = 0;

  t0.stage1_ticks = 0;
  t1.stage1_ticks = 0;
  t2.stage1_ticks = 0;

  t0.stage2_ticks = 0;
  t1.stage2_ticks = 0;
  t2.stage2_ticks = 0;

  t0.stage3_ticks = 0;
  t1.stage3_ticks = 0;
  t2.stage3_ticks = 0;

  t0.current_line = 0;
  t1.current_line = 0;
  t2.current_line = 0;

  t0.enabled = false;
  t1.enabled = false;
  t2.enabled = false;
}

SMP::SMP() {
  // put this in the ctor instead of reset so that something will still get dumped on reset if it hasn't been (?)
  dump_spc = false;
}

SMP::~SMP() {
}

void SMP::load_dump(uint8 *dump, uint16_t pc, uint8_t r[4], uint8_t p) {
  memcpy(memory::apuram.data(), dump, memory::apuram.size());

  // set up some status from RAM values
  op_buswrite(0xFC, dump[0xFC]);
  op_buswrite(0xFB, dump[0xFB]);
  op_buswrite(0xFA, dump[0xFA]);
  op_buswrite(0xF9, dump[0xF9]);
  op_buswrite(0xF8, dump[0xF8]);
  op_buswrite(0xF2, dump[0xF2]);
  op_buswrite(0xF1, dump[0xF1] & 0x87);
 
  port.cpu_to_smp[0] = dump[0xF4];
  port.cpu_to_smp[1] = dump[0xF5];
  port.cpu_to_smp[2] = dump[0xF6];
  port.cpu_to_smp[3] = dump[0xF7];
  
  t0.stage3_ticks = dump[0xFD] & 15;
  t1.stage3_ticks = dump[0xFE] & 15;
  t2.stage3_ticks = dump[0xFF] & 15;
  
  // set SMP registers
  regs.pc   = pc;
  regs.r[0] = r[0];
  regs.r[1] = r[1];
  regs.r[2] = r[2];
  regs.r[3] = r[3];
  regs.p    = p;
  
  // read DSP registers
  dsp.load(dump + memory::apuram.size());
}

void SMP::save_spc_dump(string path) {
  dump_spc = true;
  spc_path = path;
  if(config().spc_save_policy == SPCSavePolicy::Immediately) {
    save_spc_dump();
  }
}

void SMP::save_spc_dump() {
  dump_spc = false;
    
  file out;
  if (!out.open(spc_path(), file::mode::write)) {
    return;
  }
  
  out.write((const uint8_t*)"SNES-SPC700 Sound File Data v0.30\x1a\x1a\x1a\x1e", 0x25);
  out.writel(regs.pc, 2);
  out.write(regs.a);
  out.write(regs.x);
  out.write(regs.y);
  out.write(regs.p);
  out.write(regs.sp);
  out.write(0);
  out.write(0);
  
  // just write completely blank ID666 tag
  for (unsigned i = 0x2e; i < 0x100; i++) out.write(0);
  
  // 0000 - 00EF
  out.write(memory::apuram.data(), 0xF0);
  
  // 00F0 - 00FF
  out.write(memory::apuram[0xF0]);
  out.write(memory::apuram[0xF1]);
  out.write(status.dsp_addr);
  out.write(dsp.read(status.dsp_addr & 0x7f));
  
  out.write(port.cpu_to_smp[0]);
  out.write(port.cpu_to_smp[1]);
  out.write(port.cpu_to_smp[2]);
  out.write(port.cpu_to_smp[3]);
  
  out.write(port.aux[0]);
  out.write(port.aux[1]);
  
  out.write(memory::apuram[0xFA]);
  out.write(memory::apuram[0xFB]);
  out.write(memory::apuram[0xFC]);
  
  out.write(t0.stage3_ticks & 15);
  out.write(t1.stage3_ticks & 15);
  out.write(t2.stage3_ticks & 15);
  
  // 0100 - FFFF
  out.write(memory::apuram.data() + 0x100, 0xFF00);
  
  for (unsigned i = 0; i < 128; i++) {
    out.write(dsp.read(i));
  }
  
  for (unsigned i = 0; i < 128; i++) {
    out.write(0);
  }
  
  out.close();
}

}