#include <stdio.h>
#include <Stream.h>

#include "memory.h"
#include "CPU.h"
#include "ports.h"
#include "i8080.h"

void i8080::run(unsigned clocks) {
	while (clocks--) {
		uint8_t op = _mem[PC];
		PC++;
		_op(op);
		if (_halted)
			break;
	}
}

void i8080::reset() {
	A = 0;
	_sr(0);
	BC = DE = HL = PC = SP = 0;
	_irq_pending = 0;
	_halted = false;
}

void i8080::raise(int level) {
	if (flags.I) {
		flags.I = 0;
		_irq_pending = 0;
		_push(PC);
		PC = level * 8;
	} else
		_irq_pending = level;
}

char *i8080::status(char *buf, size_t n, bool hdr) {
#if defined(CPU_DEBUG)
	uint8_t op = _mem[PC];
	snprintf(buf, n,
		"%s%04x %02x %02x %04x %04x %04x %04x %d%d%d%d%d%d%d%d",
		hdr? "_pc_ op aa _bc_ _de_ _hl_ _sp_ szih_p_c\r": "",
		PC, op, A, BC, DE, HL, SP, flags.S, flags.Z, flags.I, flags.H,
		flags._, flags.P, flags.__, flags.C);
#endif
	return buf;
}

void i8080::checkpoint(Stream &s) {
#if !defined(NO_CHECKPOINT)
	s.write(A);
	s.write(SR);
	s.write(BC);
	s.write(DE);
	s.write(HL);
	s.write(PC);
	s.write(SP);
	s.write(_irq_pending);
#endif
}

void i8080::restore(Stream &s) {
#if !defined(NO_CHECKPOINT)
	A = s.read();
	SR = s.read();
	BC = s.read();
	DE = s.read();
	HL = s.read();
	PC = s.read();
	SP = s.read();
	_irq_pending = s.read();
#endif
}

void i8080::daa() {
	uint8_t c = flags.C, a = 0, hi = (A & 0xf0) >> 4, lo = A & 0x0f;
	if (flags.H || lo > 9)
		a = 0x06;
	if (flags.C || hi > 0x9 || (hi >= 0x9 && lo > 9)) {
		a |= 0x60;
		c = 1;
	}
	_add(a);
	flags.C = c;
}

int i8080::parity_table[] = {
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
	1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
};

i8080::i8080(Memory &m, PortDevice<i8080> &d): CPU(m), _ports(&d)
{
}

void i8080::_op(uint8_t op) {

#define O(o, e) case o: e; break;

	switch(op) {
	// 0x
	O(0x00, nop()); O(0x01, lxib());
	O(0x02, staxb()); O(0x03, inxb());
	O(0x04, inrb()); O(0x05, dcrb());
	O(0x06, mvib()); O(0x07, rlc());
	O(0x08, nop()); O(0x09, dadb());
	O(0x0a, ldaxb()); O(0x0b, dcxb());
	O(0x0c, inrc()); O(0x0d, dcrc());
	O(0x0e, mvic()); O(0x0f, rrc());

	// 1x
	O(0x10, nop()); O(0x11, lxid());
	O(0x12, staxd()); O(0x13, inxd());
	O(0x14, inrd()); O(0x15, dcrd());
	O(0x16, mvid()); O(0x17, ral());
	O(0x18, nop()); O(0x19, dadd());
	O(0x1a, ldaxd()); O(0x1b, dcxd());
	O(0x1c, inre()); O(0x1d, dcre());
	O(0x1e, mvie()); O(0x1f, rar());

	// 2x
	O(0x20, nop()); O(0x21, lxih());
	O(0x22, shld()); O(0x23, inxh());
	O(0x24, inrh()); O(0x25, dcrh());
	O(0x26, mvih()); O(0x27, daa());
	O(0x28, nop()); O(0x29, dadh());
	O(0x2a, lhld()); O(0x2b, dcxh());
	O(0x2c, inrl()); O(0x2d, dcrl());
	O(0x2e, mvil()); O(0x2f, cma());

	// 3x
	O(0x30, nop()); O(0x31, lxisp());
	O(0x32, sta()); O(0x33, inxsp());
	O(0x34, inrm()); O(0x35, dcrm());
	O(0x36, mvim()); O(0x37, stc());
	O(0x38, nop()); O(0x39, dadsp());
	O(0x3a, lda()); O(0x3b, dcxsp());
	O(0x3c, inra()); O(0x3d, dcra());
	O(0x3e, mvia()); O(0x3f, cmc());

	// 4x
	O(0x40, movbb()); O(0x41, movbc());
	O(0x42, movbd()); O(0x43, movbe());
	O(0x44, movbh()); O(0x45, movbl());
	O(0x46, movbm()); O(0x47, movba());
	O(0x48, movcb()); O(0x49, movcc());
	O(0x4a, movcd()); O(0x4b, movce());
	O(0x4c, movch()); O(0x4d, movcl());
	O(0x4e, movcm()); O(0x4f, movca());

	// 5x
	O(0x50, movdb()); O(0x51, movdc());
	O(0x52, movdd()); O(0x53, movde());
	O(0x54, movdh()); O(0x55, movdl());
	O(0x56, movdm()); O(0x57, movda());
	O(0x58, moveb()); O(0x59, movec());
	O(0x5a, moved()); O(0x5b, movee());
	O(0x5c, moveh()); O(0x5d, movel());
	O(0x5e, movem()); O(0x5f, movea());

	// 6x
	O(0x60, movhb()); O(0x61, movhc());
	O(0x62, movhd()); O(0x63, movhe());
	O(0x64, movhh()); O(0x65, movhl());
	O(0x66, movhm()); O(0x67, movha());
	O(0x68, movlb()); O(0x69, movlc());
	O(0x6a, movld()); O(0x6b, movle());
	O(0x6c, movlh()); O(0x6d, movll());
	O(0x6e, movlm()); O(0x6f, movla());

	// 7x
	O(0x70, movmb()); O(0x71, movmc());
	O(0x72, movmd()); O(0x73, movme());
	O(0x74, movmh()); O(0x75, movml());
	O(0x76, hlt()); O(0x77, movma());
	O(0x78, movab()); O(0x79, movac());
	O(0x7a, movad()); O(0x7b, movae());
	O(0x7c, movah()); O(0x7d, moval());
	O(0x7e, movam()); O(0x7f, movaa());

	// 8x
	O(0x80, addb()); O(0x81, addc());
	O(0x82, addd()); O(0x83, adde());
	O(0x84, addh()); O(0x85, addl());
	O(0x86, addm()); O(0x87, adda());
	O(0x88, adcb()); O(0x89, adcc());
	O(0x8a, adcd()); O(0x8b, adce());
	O(0x8c, adch()); O(0x8d, adcl());
	O(0x8e, adcm()); O(0x8f, adca());

	// 9x
	O(0x90, subb()); O(0x91, subc());
	O(0x92, subd()); O(0x93, sube());
	O(0x94, subh()); O(0x95, subl());
	O(0x96, subm()); O(0x97, suba());
	O(0x98, sbbb()); O(0x99, sbbc());
	O(0x9a, sbbd()); O(0x9b, sbbe());
	O(0x9c, sbbh()); O(0x9d, sbbl());
	O(0x9e, sbbm()); O(0x9f, sbba());

	// Ax
	O(0xa0, anab()); O(0xa1, anac());
	O(0xa2, anad()); O(0xa3, anae());
	O(0xa4, anah()); O(0xa5, anal());
	O(0xa6, anam()); O(0xa7, anaa());
	O(0xa8, xrab()); O(0xa9, xrac());
	O(0xaa, xrad()); O(0xab, xrae());
	O(0xac, xrah()); O(0xad, xral());
	O(0xae, xram()); O(0xaf, xraa());

	// Bx
	O(0xb0, orab()); O(0xb1, orac());
	O(0xb2, orad()); O(0xb3, orae());
	O(0xb4, orah()); O(0xb5, oral());
	O(0xb6, oram()); O(0xb7, oraa());
	O(0xb8, cmpb()); O(0xb9, cmpc());
	O(0xba, cmpd()); O(0xbb, cmpe());
	O(0xbc, cmph()); O(0xbd, cmpl());
	O(0xbe, cmpm()); O(0xbf, cmpa());

	// Cx
	O(0xc0, rnz()); O(0xc1, popb());
	O(0xc2, jnz()); O(0xc3, jmp());
	O(0xc4, cnz()); O(0xc5, pushb());
	O(0xc6, adi()); O(0xc7, rst0());
	O(0xc8, rz()); O(0xc9, ret());
	O(0xca, jz()); O(0xcb, jmp());
	O(0xcc, cz()); O(0xcd, call());
	O(0xce, aci()); O(0xcf, rst1());

	// Dx
	O(0xd0, rnc()); O(0xd1, popd());
	O(0xd2, jnc()); O(0xd3, out());
	O(0xd4, cnc()); O(0xd5, pushd());
	O(0xd6, sui()); O(0xd7, rst2());
	O(0xd8, rc()); O(0xd9, ret());
	O(0xda, jc()); O(0xdb, in());
	O(0xdc, cc()); O(0xdd, call());
	O(0xde, sbi()); O(0xdf, rst3());

	// Ex
	O(0xe0, rpo()); O(0xe1, poph());
	O(0xe2, jpo()); O(0xe3, xthl());
	O(0xe4, cpo()); O(0xe5, pushh());
	O(0xe6, ani()); O(0xe7, rst4());
	O(0xe8, rpe()); O(0xe9, pchl());
	O(0xea, jpe()); O(0xeb, xchg());
	O(0xec, cpe()); O(0xed, call());
	O(0xee, xri()); O(0xef, rst5());

	// Fx
	O(0xf0, rp()); O(0xf1, pop());
	O(0xf2, jp()); O(0xf3, di());
	O(0xf4, cp()); O(0xf5, push());
	O(0xf6, ori()); O(0xf7, rst6());
	O(0xf8, rm()); O(0xf9, sphl());
	O(0xfa, jm()); O(0xfb, ei());
	O(0xfc, cm()); O(0xfd, call());
	O(0xfe, cpi()); O(0xff, rst7());
	}
}