#include <stdio.h>
#include <string.h>

#include "6502_emulate.h"

#define MAX_INPUT	65536
static unsigned char input[MAX_INPUT];

#define src	0x0
#define dst	0x2
#define end	0x4
#define count	0x6
#define delta	0x8
#define A1L	0x3c
#define A1H	0x3d
#define A2L	0x3e
#define A2H	0x3f
#define A4L	0x42
#define A4H	0x43

static void getsrc(void) {
//getsrc:
	a=ram[y_indirect(src,y)];		// lda 	(src), y
	ram[src]++;				//inc	src
	if (ram[src]!=0) goto done_getsrc;	//bne	+
	ram[src+1]++;				//inc	src+1
done_getsrc: ;
	printf("LOADED %02X%02X-1: %02X\n",ram[src+1],ram[src],a);
	//+	rts
}

void buildcount(void) {

//buildcount:
	x=1;					// ldx	#1
	ram[count+1]=x; 			// stx	count+1
	cmp(0xf);				// cmp	#$0f
	if (z==0) goto done_buildcount;		// bne	++
minus_buildcount:
	ram[count]=a;				//-	sta	count
	getsrc();				//jsr	getsrc
	x=a;					//tax
	c=0;					//clc
	adc(ram[count]);			//adc	count
	if (c==0) goto skip_buildcount;		// bcc	+
	ram[count+1]++;				//inc	count+1
skip_buildcount:
	x++;					//+	inx
	x&=0xff;
	if (x==0) goto minus_buildcount;	//beq	-
done_buildcount: ;				//++	rts
}


static void putdst(void) {
	printf("PUTADDR=%04X\n",y_indirect(dst,y));
						// putdst:
	ram[y_indirect(dst,y)]=a;		//	sta 	(dst), y
	ram[dst]++;				//	inc	dst
	if (ram[dst]!=0) goto putdst_end;	//	bne	+
	ram[dst+1]++;				//	inc	dst+1
putdst_end:;
						//+	rts
	printf("PUT: %02X%02X-1,%02X = %02X\n",ram[dst+1],ram[dst],y,a);
	printf("0x8000 = %02X\n",ram[0x8000]);
}

static void getput(void) {
						// getput:
	getsrc();				// jsr	getsrc
	putdst();				// ; fallthrough
}

static void docopy(void) {
						// docopy:
docopy_label:
	getput();				// jsr	getput
	x--;					// dex
	if (x!=0) goto docopy_label;		// bne	docopy
	ram[count+1]--;				// dec	count+1
	if (ram[count+1]!=0) goto docopy_label;	//bne	docopy
						//rts
}






int main(int argc, char **argv) {

	FILE *fff;
	int size;
	short orgoff,paksize,pakoff;

	init_6502();

	fff=fopen("../mockingboard/outi.raw.lz4","r");
	if (fff==NULL) {
		fprintf(stderr,"Error opening!\n");
		return -1;
	}

	size=fread(input,sizeof(unsigned char),MAX_INPUT,fff);
	printf("Read %d bytes\n",size);

	fclose(fff);

	memcpy(&ram[0x2000],input,size);

	//LZ4 data decompressor for Apple II
	//Peter Ferrie (peter.ferrie@gmail.com)

	//init	=	0 ;set to 1 if you know the values
	//hiunp	=	0 ;unpacker entirely in high memory
	//hipak	=	0 ;packed data entirely in high memory (requires hiunp)

	//oep = 0; //first unpacked byte to run, you must set this by yourself
	orgoff = 0x8000; //offset of first unpacked byte, you must set this by yourself
	paksize	= size; //size of packed data, you must set this by yourself if hiunp=0
	pakoff = 0x2008; // 8 byte offset to data?


//LCBANK2	=	$c083
//MOVE	=	$fe2c

	a=(pakoff&0xff);	//lda	#<pakoff ;packed data offset
	ram[src]=a;		//sta	src
	a=(pakoff+paksize)&0xff;//lda	#<(pakoff+paksize) ;packed data size
	ram[end]=a;		// sta	end
	a=(pakoff>>8);		//lda	#>pakoff
	ram[src+1]=a;		//sta	src+1
	a=(pakoff+paksize)>>8;	//lda	#>(pakoff+paksize)
	ram[end+1]=a;		//	sta	end+1
	a=(orgoff>>8);		//lda	#>orgoff ;original unpacked data offset
	ram[dst+1]=a;		//sta	dst+1
	a=(orgoff&0xff);	//lda	#<orgoff
	ram[dst]=a;		// sta	dst

	printf("packed addr: %02X%02X\n",ram[src+1],ram[src]);
	printf("packed end : %02X%02X\n",ram[end+1],ram[end]);
	printf("dest addr  : %02X%02X\n",ram[dst+1],ram[dst]);


//unpack:				//;unpacker entrypoint
	goto unpmain;			// jmp	unpmain

unpmain:
	y=0;				//ldy	#0

parsetoken:
	getsrc();			// jsr	getsrc
	pha();				// pha
	a>>=1;				// lsr
	a>>=1;				// lsr
	a>>=1;				// lsr
	a>>=1;				// lsr
	a&=0xff;
	if (a==0) goto copymatches; 	// beq	copymatches

	buildcount();			// jsr	buildcount
	x=a;				// tax
	docopy();			// jsr	docopy
	a=ram[src];			// lda	src
	cmp(ram[end]);			// cmp	end
	a=ram[src+1];			// lda	src+1
	sbc(ram[end+1]);		// sbc	end+1
	if (c) {
		printf("Done!\n");
		printf("src        : %02X%02X\n",ram[src+1],ram[src]);
		printf("packed end : %02X%02X\n",ram[end+1],ram[end]);
		goto done;		// bcs	done
	}

copymatches:
	getsrc();			// jsr	getsrc
	ram[delta]=a;			// sta	delta
	getsrc();			// jsr	getsrc
	ram[delta+1]=a;			// sta	delta+1
	pla();				// pla
	a=a&0xf;			// and	#$0f
	buildcount();			// jsr	buildcount
	c=0;				// clc
	adc(4);				// adc	#4
	x=a;				// tax
	if (c==0) goto copy_skip;	// bcc	+
	ram[count+1]++;			// inc	count+1
copy_skip:
	a=ram[src+1];			//+	lda	src+1
	pha();				// pha
	a=ram[src];			// lda	src
	pha();				// pha
	c=1;				// sec
	a=ram[dst];			// lda	dst
	sbc(ram[delta]);		// sbc	delta
	ram[src]=a;			// sta	src
	a=ram[dst+1];			// lda	dst+1
	sbc(ram[delta+1]);		// sbc	delta+1
	ram[src+a]=a;			// sta	src+1
	docopy();			// jsr	docopy
	pla();				// pla
	ram[src]=a;			// sta	src
	pla();				// pla
	ram[src+1]=a;			// sta	src+1
	goto parsetoken;		// jmp	parsetoken

done:
	pla();				// pla


	int i;
	for(i=0;i<256;i++) {
		if (i%16==0) printf("\n%04X: ",0x8000+i);
		printf("%02X ",ram[0x8000+i]);
	}

	printf("\n");
					// rts
	return 0;
}