#include <stdio.h>
#include <stdlib.h>

//#define FIXED_IMPLEMENTATION	0
//#define FIXED_IMPLEMENTATION	1
//#define FIXED_IMPLEMENTATION	2
#define FIXED_IMPLEMENTATION	3


#if FIXED_IMPLEMENTATION==0
int fixed_mul(int x_i,int x_f,
		int y_i,int y_f,
		int *z_i,int *z_f,
		int debug) {

        short a,b;
	int c;

        a=((x_i)<<8)+(x_f);
        b=((y_i)<<8)+(y_f);

        c=a*b;

	if (debug) {
		printf("%x:%x (%d) * %x:%x (%d) = %x (%d)\n",
			x_i,x_f,a,
			y_i,y_f,b,
			c,c);
	}

        c>>=8;

	*z_i=(c>>8);
	*z_f=(c&0xff);


	return a*b;
}
#endif


#if FIXED_IMPLEMENTATION==1
int fixed_mul(int x_i,int x_f,
		int y_i, int y_f,
		int *z_i, int *z_f,
			int debug) {

	int num1h,num1l;
	int num2h,num2l;
	int result3;
	int result2,result1,result0;
	int aa,xx,cc=0,cc2,yy;
	int negate=0;

	num1h=x_i;
	num1l=x_f;

	if (!(num1h&0x80)) goto check_num2;	// bpl check_num2

	negate++;				// inc negate

	num1l=~num1l;
	num1h=~num1h;

	num1l&=0xff;
	num1h&=0xff;

	num1l+=1;
	cc=!!(num1l&0x100);
	num1h+=cc;

	num1l&=0xff;
	num1h&=0xff;
check_num2:

	num2h=y_i;
	num2l=y_f;

	if (!(num2h&0x80)) goto unsigned_multiply;

	negate++;

	num2l=~num2l;
	num2h=~num2h;

	num2l&=0xff;
	num2h&=0xff;

	num2l+=1;
	cc=!!(num2l&0x100);
	num2h+=cc;

	num2l&=0xff;
	num2h&=0xff;

unsigned_multiply:

	if (debug) {
		printf("Using %02x:%02x * %02x:%02x\n",num1h,num1l,num2h,num2l);
	}

	result0=0;
	result1=0;


//label_multiply:
	aa=0;		// lda #0 (sz)
	result2=aa;	// sta result+2
	xx=16;		// ldx #16 (sz)
label_l1:
	cc=(num2h&1);	//lsr NUM2+1 (szc)
	num2h>>=1;
	num2h&=0x7f;
//	if (num2_neg) {
//		num2h|=0x80;
//	}

	cc2=(num2l&1);	// ror NUM2 (szc)
	num2l>>=1;
	num2l&=0x7f;


	num2l|=(cc<<7);
	cc=cc2;

	if (cc==0) goto label_l2;	// bcc L2

	yy=aa;				// tay (sz)
	cc=0;				// clc
	aa=num1l;			// lda NUM1 (sz)
	aa=aa+cc+result2;		// adc RESULT+2 (svzc)
	cc=!!(aa&0x100);
	aa&=0xff;
	result2=aa;			// sta RESULT+2
	aa=yy;				// tya
	aa=aa+cc+num1h;			// adc NUM1+1
	cc=!!(aa&0x100);
	aa=aa&0xff;

label_l2:
	cc2=aa&1;
	aa=aa>>1;
	aa&=0x7f;
	aa|=cc<<7;
	cc=cc2;		// ror A

	cc2=result2&1;
	result2=result2>>1;
	result2&=0x7f;
	result2|=(cc<<7);
	cc=cc2;		// ror result+2

	cc2=result1&1;
	result1=result1>>1;
	result1&=0x7f;
	result1|=cc<<7;
	cc=cc2;		// ror result+1

	cc2=result0&1;
	result0=result0>>1;
	result0&=0x7f;
	result0|=cc<<7;
	cc=cc2;		// ror result+0

	xx--;				// dex
	if (xx!=0) goto label_l1;	// bne L1

	result3=aa&0xff;		// sta result+3


	if (debug) {
		printf("RAW RESULT = %02x:%02x:%02x:%02x\n",
			result3&0xff,result2&0xff,result1&0xff,result0&0xff);
	}

	if (negate&1) {
//		printf("NEGATING!\n");

		cc=0;

		aa=0;
		aa-=result0+cc;
		cc=!!(aa&0x100);
		result0=aa;

		aa=0;
		aa-=result1+cc;
		cc=!!(aa&0x100);
		result1=aa;

		aa=0;
		aa-=result2+cc;
		cc=!!(aa&0x100);
		result2=aa;

		aa=0;
		aa-=result3+cc;
		cc=!!(aa&0x100);
		result3=aa;

	}

	*z_i=result2&0xff;
	*z_f=result1&0xff;

	result3&=0xff;
	result2&=0xff;
	result1&=0xff;
	result0&=0xff;


	if (debug) {
		printf("%02x:%02x * %02x:%02x = %02x:%02x:%02x:%02x\n",
			num1h,num1l,y_i,y_f,
			result3&0xff,result2&0xff,result1&0xff,result0&0xff);

//		printf("%02x%02x * %02x%02x = %02x%02x%02x%02x\n",
//			num1h,num1l,y_i,y_f,
//			result3,result2,result1,result0);
	}

	int a2;
//	int s1,s2;
//	s1=(num1h<<8)|(num1l);
//	s2=(y_i<<8)|(y_f);
	a2=(result3<<24)|(result2<<16)|(result1<<8)|result0;
//	printf("%d * %d = %d (0x%x)\n",s1,s2,a2,a2);


	return a2;

}
#endif


#if FIXED_IMPLEMENTATION==2

// Description: Unsigned 16-bit multiplication with unsigned 32-bit result.
// Input: 16-bit unsigned value in T1
// 16-bit unsigned value in T2
// Carry=0: Re-use T1 from previous multiplication (faster)
// Carry=1: Set T1 (slower)
//
// Output: 32-bit unsigned value in PRODUCT
// Clobbered: PRODUCT, X, A, C
// Allocation setup: T1,T2 and PRODUCT preferably on Zero-page.
//                   square1_lo, square1_hi, square2_lo, square2_hi must be
//                   page aligned. Each table are 512 bytes. Total 2kb.
//
// Table generation: I:0..511
//                   square1_lo = <((I*I)/4)
//                   square1_hi = >((I*I)/4)
//                   square2_lo = <(((I-255)*(I-255))/4)
//                   square2_hi = >(((I-255)*(I-255))/4)

static unsigned char square1_lo[512];
static unsigned char square1_hi[512];
static unsigned char square2_lo[512];
static unsigned char square2_hi[512];

static int table_ready=0;

static void init_table(void) {

	int i;

	for(i=0;i<512;i++) {
		square1_lo[i]=((i*i)/4)&0xff;
		square1_hi[i]=(((i*i)/4)>>8)&0xff;
		square2_lo[i]=( ((i-255)*(i-255))/4)&0xff;
		square2_hi[i]=(( ((i-255)*(i-255))/4)>>8)&0xff;
//		printf("%d %x:%x %x:%x\n",i,square1_hi[i],square1_lo[i],
//			square2_hi[i],square2_lo[i]);
	}
	table_ready=1;

	// 3 * 2
	// 3+2 = 5
	// 3-2 = 1
	// (25 - 1) = 24/4 = 6

//	int num1l,num2l,a1,a2;

//	num1l=7;
//	num2l=9;

//	printf("Trying %d*%d\n",num1l,num2l);
//	a1=square1_lo[num1l+num2l];
//	printf("((%d+%d)^2)/4: %d\n",num1l,num2l,a1);
//	a2=square2_lo[((~num1l)&0xff)+num2l];
//	printf("((%d-%d)^2)/4: %d\n",num1l,num2l,a2);

//	printf("%d*%d=%d\n",num1l,num2l,a1-a2);

}

static unsigned int product[4];

int fixed_mul_unsigned(int x_i,int x_f,
		int y_i, int y_f,
		int *z_i, int *z_f,
			int debug) {

//	<T1 * <T2 = AAaa
//	<T1 * >T2 = BBbb
//	>T1 * <T2 = CCcc
//	>T1 * >T2 = DDdd
//
//	       AAaa
//	     BBbb
//	     CCcc
//	 + DDdd
//	 ----------
//	   PRODUCT!

//                ; Setup T1 if changed
	int c=0;
	int a,x;
	int sm1a,sm3a,sm5a,sm7a;
	int sm2a,sm4a,sm6a,sm8a;
	int sm1b,sm3b,sm5b,sm7b;
	int sm2b,sm4b,sm6b,sm8b;

	int _AA,_BB,_CC,_DD,_aa,_bb,_cc,_dd;

	if (!table_ready) init_table();

//	printf("\t\t\tMultiplying %2x:%2x * %2x:%2x\n",x_i,x_f,y_i,y_f);

	/* Set up self-modifying code */
	if (c==0) {
		a=(x_f)&0xff;		// lda T1+0		; 3
		sm1a=a;			// sta sm1a+1		; 3
		sm3a=a;			// sta sm3a+1		; 3
		sm5a=a;			// sta sm5a+1		; 3
		sm7a=a;			// sta sm7a+1		; 3
		a=(~a)&0xff;		// eor #$ff		; 2
		sm2a=a;			// sta sm2a+1		; 3
		sm4a=a;			// sta sm4a+1		; 3
		sm6a=a;			// sta sm6a+1		; 3
		sm8a=a;			// sta sm8a+1		; 3
		a=(x_i)&0xff;		// lda T1+1		; 3
		sm1b=a;			// sta sm1b+1		; 3
		sm3b=a;			// sta sm3b+1		; 3
		sm5b=a;			// sta sm5b+1		; 3
		sm7b=a;			// sta sm7b+1		; 3
		a=(~a)&0xff;		// eor #$ff		; 2
		sm2b=a;			// sta sm2b+1		; 3
		sm4b=a;			// sta sm4b+1		; 3
		sm6b=a;			// sta sm6b+1		; 3
		sm8b=a;			// sta sm8b+1		; 3
	}

	/* Perform <T1 * <T2 = AAaa */
	x=(y_f)&0xff;			// ldx T2+0 (low le)		; 3
	c=1;					// sec			; 2
//sm1a:
	a=square1_lo[sm1a+x];			// lda square1_lo,x	; 4
//sm2a:
	a+=~(square2_lo[sm2a+x])+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;

//	printf("\t\t\t\ta=(%d+%d)^2/4=%d "
//		"b=(%d+%d)^2/4=%d\n",
//		sm1a,x,square1_lo[sm1a+x],
//		sm2a,x,square2_lo[sm2a+x]);
	product[0]=a;				// sta PRODUCT+0	; 3
	_aa=a;
//	printf("\t\t\t\ta-b aa=%2x\n",a);
//sm3a:
	a=square1_hi[sm3a+x];			// lda square1_hi,x	; 4
//sm4a:
	a+=(~(square2_hi[sm4a+x]))+c;		// sbc square2_hi,x	; 4
	c=!(a&0x100);
	a&=0xff;

//	printf("\t\t\t\ta=%d b=%d\n",square1_hi[sm3a+x],square2_hi[sm4a+x]);

	_AA=a;					// sta _AA+1		; 3
//	printf("\t\t\t\tAA=%2x\n",a);

	/* Perform >T1_hi * <T2 = CCcc */
	c=1;					// sec			; 2
//sm1b:
	a=square1_lo[sm1b+x];			// lda square1_lo,x	; 4
//sm2b:
	a+=(~(square2_lo[sm2b+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;

	_cc=a;					// sta _cc+1		; 3
//sm3b:
	a=square1_hi[sm3b+x];			// lda square1_hi,x	; 4
//sm4b:
	a+=(~(square2_hi[sm4b+x]))+c;		// sbc square2_hi,x	; 4
	c=!!(a&0x100);
	a&=0xff;
	_CC=a;					// sta _CC+1		; 3

	/* Perform <T1 * >T2 = BBbb */
	x=(y_i)&0xff;				// ldx T2+1		; 3
	c=1;					// sec			; 2
//sm5a:
	a=square1_lo[sm5a+x];			// lda square1_lo,x	; 4
//sm6a:
	a+=(~(square2_lo[sm6a+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_bb=a;					// sta _bb+1		; 3
//	printf("\t\t\t\tbb=%x c=%d\n",_bb,c);
//sm7a:
	a=square1_hi[sm7a+x];			// lda square1_hi,x	; 4
//sm8a:
	a+=(~(square2_hi[sm8a+x]))+c;		// sbc square2_hi,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_BB=a;					// sta _BB+1

	/* Perform >T1 * >T2 = DDdd */
	c=1;					// sec			; 2
//sm5b:
	a=square1_lo[sm5b+x];			// lda square1_lo,x	; 4
//sm6b:
	a+=(~(square2_lo[sm6b+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_dd=a;					// sta _dd+1		; 3
//sm7b:
	a=square1_hi[sm7b+x];			// lda square1_hi,x	; 4
//sm8b:
	a+=(~(square2_hi[sm8b+x]))+c;		// sbc square2_hi,x	; 4
	c=!(a&0x100);
	a&=0xff;

	product[3]=a;				// sta PRODUCT+3	; 3
	_DD=a;

	/*********************************************/
	/* Add the separate multiplications together */
	/*********************************************/

	// product[0]=_aa;
	if (debug) printf("product[0]=0.%02x\n",_aa);

	// product[1]=_AA+_bb+(_cc)
	if (debug) printf("product[1]=%02x+%02x+0=",_AA,_bb);

	c=0;					// clc			; 2
//_AA:
	a=_AA;					// lda #0		; 2
//_bb:
	a+=(c+_bb);				// adc #0		; 2
	c=!!(a&0x100);
	a&=0xff;
	product[1]=a;				// sta PRODUCT+1	; 3
	if (debug) printf("%x.%02x\n",c,a);

	// product[2]=_BB+_CC+c
	if (debug) printf("product[2]=%02x+%02x+%d=",_BB,_CC,c);
//_BB:
	a=_BB;					// lda #0		; 2
//_CC:
	a+=(c+_CC);				// adc #0		; 2
	c=!!(a&0x100);
	a&=0xff;
	product[2]=a;				// sta PRODUCT+2	; 3
	if (debug) printf("%x.%02x\n",c,a);

	// product[3]=_DD+c
	if (debug) printf("product[3]=%02x+%d=",_DD,c);
	if (c==0) goto urgh2;			// bcc :+		; 2nt/3
	product[3]++;				// inc PRODUCT+3	; 5
	product[3]&=0xff;
	c=0;					// clc			; 2
urgh2:
	if (debug) printf("%x.%02x\n",c,product[3]);
	// product[1]=_AA+_bb+_cc
	if (debug) printf("product[1]=%02x+%02x+%d=",product[1],_cc,c);
//_cc:
	a=_cc;					// lda #0		; 2
	a+=c+product[1];			// adc PRODUCT+1	; 3
	c=!!(a&0x100);
	a&=0xff;
	product[1]=a;				// sta PRODUCT+1	; 3
	if (debug) printf("%x.%02x\n",c,product[1]);

	// product[2]=_BB+_CC+_dd+c
	if (debug) printf("product[2]=%02x+%02x+%d=",product[2],_dd,c);
//_dd:
	a=_dd;					// lda #0		; 2
	a+=c+product[2];			// adc PRODUCT+2	; 3
	c=!!(a&0x100);
	a&=0xff;
	product[2]=a;				// sta PRODUCT+2	; 3
	if (debug) printf("%x.%02x\n",c,product[2]);

	// product[3]=_DD+c
	if (debug) printf("product[3]=%02x+%d=",product[3],c);
	if (c==0) goto urgh;			// bcc :+		; 2nt/3
	product[3]++;				// inc PRODUCT+3	; 5
	product[3]&=0xff;
urgh:
	if (debug) printf("%x.%02x\n",c,product[3]);
	*z_i=product[1];
	*z_f=product[0];

//	printf("Result=%02x:%02x\n",*z_i,*z_f);

	if (debug) {
		printf("    AAaa        %02x:%02x\n",_AA,_aa);
		printf("  BBbb       %02x:%02x\n",_BB,_bb);
		printf("  CCcc       %02x:%02x\n",_CC,_cc);
		printf("DDdd      %02x:%02x\n",_DD,_dd);
	}

	return (product[3]<<24)|(product[2]<<16)|(product[1]<<8)|product[0];
						// rts			; 6
}

/* signed */
int fixed_mul(int x_i,int x_f,
		int y_i, int y_f,
		int *z_i, int *z_f,
			int debug) {

	int a,c;

	fixed_mul_unsigned(x_i,x_f,y_i,y_f,z_i,z_f,debug);
					// jsr multiply_16bit_unsigned	; 6

	a=(x_i&0xff);			// lda T1+1			; 3
	if ((a&0x80)==0) goto x_positive;	// bpl :+		; 3/2nt
	if (debug) printf("Before:   %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

//	a=0xff;			// lda #$ff	; 2
//	c=1;			// sec		; 2
//	a=product[0]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[0]=a;		// sta product[0]; 3


//	a=0xff;			// lda #$ff	; 2
//	a=product[1]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[1]=a;		// sta product[0]; 3


//	a=0xff;
//	a=product[2]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[2]=a;		// sta product[0]; 3


//	a=0xff;
//	a=product[3]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[3]=a;		// sta product[0]; 3

//	product[1]^=a;
//	product[2]^=a;
//	product[3]^=a;


	c=1;				// sec				; 2
	a=product[2];			// lda PRODUCT+2		; 3
	a+=(~y_f)+c;			// sbc T2+0			; 3
	c=!(a&0x100);
	a&=0xff;
	product[2]=a;			// sta PRODUCT+2		; 3
	a=product[3];			// lda PRODUCT+3		; 3
	a+=(~y_i)+c;			// sbc T2+1			; 3
	c=!(a&0x100);
	a&=0xff;
	product[3]=a;			// sta PRODUCT+3		; 3
	if (debug) printf("After:    %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

x_positive:

	a=(y_i&0xff);				// lda T2+1			; 3
	if ((a&0x80)==0) goto y_positive;	// bpl :+		; 3/2nt

	if (debug) printf("Before:   %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);
//	a=0xff;			// lda #$ff	; 2
//	c=1;			// sec		; 2
//	a=product[0]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[0]=a;		// sta product[0]; 3


//	a=0xff;			// lda #$ff	; 2
//	a=product[1]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[1]=a;		// sta product[0]; 3


//	a=0xff;
//	a=product[2]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[2]=a;		// sta product[0]; 3


//	a=0xff;
//	a=product[3]^a;		// eor product[0]; 3
//	a&=0xff;
//	a+=0+c;			// adc #0	; 2
//	c=!!(a&0x100);
//	a&=0xff;
//	product[3]=a;		// sta product[0]; 3


	c=1;				// sec				; 2
	a=product[2];			// lda PRODUCT+2		; 3
	a+=(~x_f)+c;			// sbc T1+0			; 3
	c=!(a&0x100);
	a&=0xff;
	product[2]=a;			// sta PRODUCT+2		; 3
	a=product[3];			// lda PRODUCT+3		; 3
	a+=(~x_i)+c;			// sbc T1+1			; 3
	c=!(a&0x100);
	a&=0xff;
	product[3]=a;			// sta PRODUCT+3		; 3

	if (debug) printf("After:    %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

y_positive:
	*z_i=product[2];
	*z_f=product[1];

	return (product[3]<<24)|(product[2]<<16)|(product[1]<<8)|product[0];
						// rts			; 6
}

#endif



#if FIXED_IMPLEMENTATION==3

// Description: Unsigned 16-bit multiplication with unsigned 32-bit result.
// Input: 16-bit unsigned value in T1
// 16-bit unsigned value in T2
// Carry=0: Re-use T1 from previous multiplication (faster)
// Carry=1: Set T1 (slower)
//
// Output: 32-bit unsigned value in PRODUCT
// Clobbered: PRODUCT, X, A, C
// Allocation setup: T1,T2 and PRODUCT preferably on Zero-page.
//                   square1_lo, square1_hi, square2_lo, square2_hi must be
//                   page aligned. Each table are 512 bytes. Total 2kb.
//
// Table generation: I:0..511
//                   square1_lo = <((I*I)/4)
//                   square1_hi = >((I*I)/4)
//                   square2_lo = <(((I-255)*(I-255))/4)
//                   square2_hi = >(((I-255)*(I-255))/4)

static unsigned char square1_lo[512];
static unsigned char square1_hi[512];
static unsigned char square2_lo[512];
static unsigned char square2_hi[512];

static int table_ready=0;

static void init_table(void) {

	int i;

	for(i=0;i<512;i++) {
		square1_lo[i]=((i*i)/4)&0xff;
		square1_hi[i]=(((i*i)/4)>>8)&0xff;
		square2_lo[i]=( ((i-255)*(i-255))/4)&0xff;
		square2_hi[i]=(( ((i-255)*(i-255))/4)>>8)&0xff;
//		printf("%d %x:%x %x:%x\n",i,square1_hi[i],square1_lo[i],
//			square2_hi[i],square2_lo[i]);
	}
	table_ready=1;

	// 3 * 2
	// 3+2 = 5
	// 3-2 = 1
	// (25 - 1) = 24/4 = 6

//	int num1l,num2l,a1,a2;

//	num1l=7;
//	num2l=9;

//	printf("Trying %d*%d\n",num1l,num2l);
//	a1=square1_lo[num1l+num2l];
//	printf("((%d+%d)^2)/4: %d\n",num1l,num2l,a1);
//	a2=square2_lo[((~num1l)&0xff)+num2l];
//	printf("((%d-%d)^2)/4: %d\n",num1l,num2l,a2);

//	printf("%d*%d=%d\n",num1l,num2l,a1-a2);

}

static unsigned int product[4];

int fixed_mul(int x_i,int x_f,
		int y_i, int y_f,
		int *z_i, int *z_f,
			int debug) {

//int fixed_mul_unsigned(int x_i,int x_f,
//		int y_i, int y_f,
//			int debug) {

//	<T1 * <T2 = AAaa
//	<T1 * >T2 = BBbb
//	>T1 * <T2 = CCcc
//	>T1 * >T2 = DDdd
//
//	       AAaa
//	     BBbb
//	     CCcc
//	 + DDdd
//	 ----------
//	   PRODUCT!

//                ; Setup T1 if changed
	int c=0;
	int a,x;
	int sm1a,sm3a,sm5a,sm7a;
	int sm2a,sm4a,sm6a,sm8a;
	int sm1b,sm3b,sm5b;//,sm7b;
	int sm2b,sm4b,sm6b;//,sm8b;

	int _AA,_BB,_CC;//,_DD;
	int /* _aa,*/ _bb,_cc,_dd;

	if (!table_ready) init_table();

	//	printf("\t\t\tMultiplying %2x:%2x * %2x:%2x\n",x_i,x_f,y_i,y_f);

	/* Set up self-modifying code */
	if (c==0) {
		a=(x_f)&0xff;		// lda T1+0		; 3
		sm1a=a;			// sta sm1a+1		; 3
		sm3a=a;			// sta sm3a+1		; 3
		sm5a=a;			// sta sm5a+1		; 3
		sm7a=a;			// sta sm7a+1		; 3
		a=(~a)&0xff;		// eor #$ff		; 2
		sm2a=a;			// sta sm2a+1		; 3
		sm4a=a;			// sta sm4a+1		; 3
		sm6a=a;			// sta sm6a+1		; 3
		sm8a=a;			// sta sm8a+1		; 3
		a=(x_i)&0xff;		// lda T1+1		; 3
		sm1b=a;			// sta sm1b+1		; 3
		sm3b=a;			// sta sm3b+1		; 3
		sm5b=a;			// sta sm5b+1		; 3
//		sm7b=a;			// sta sm7b+1		; 3
		a=(~a)&0xff;		// eor #$ff		; 2
		sm2b=a;			// sta sm2b+1		; 3
		sm4b=a;			// sta sm4b+1		; 3
		sm6b=a;			// sta sm6b+1		; 3
//		sm8b=a;			// sta sm8b+1		; 3
	}

	/* Perform <T1 * <T2 = AAaa */
	x=(y_f)&0xff;			// ldx T2+0 (low le)		; 3
	c=1;					// sec			; 2
	//sm1a:
	a=square1_lo[sm1a+x];			// lda square1_lo,x	; 4
	//sm2a:
	a+=~(square2_lo[sm2a+x])+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;

	//	printf("\t\t\t\ta=(%d+%d)^2/4=%d "
	//		"b=(%d+%d)^2/4=%d\n",
	//		sm1a,x,square1_lo[sm1a+x],
	//		sm2a,x,square2_lo[sm2a+x]);
//	product[0]=a;				// sta PRODUCT+0	; 3
//	_aa=a;
	//	printf("\t\t\t\ta-b aa=%2x\n",a);
	//sm3a:
	a=square1_hi[sm3a+x];			// lda square1_hi,x	; 4
	//sm4a:
	a+=(~(square2_hi[sm4a+x]))+c;		// sbc square2_hi,x	; 4
	c=!(a&0x100);
	a&=0xff;

	//	printf("\t\t\t\ta=%d b=%d\n",square1_hi[sm3a+x],square2_hi[sm4a+x]);

	_AA=a;					// sta _AA+1		; 3
	//	printf("\t\t\t\tAA=%2x\n",a);

	/* Perform >T1_hi * <T2 = CCcc */
	c=1;					// sec			; 2
	//sm1b:
	a=square1_lo[sm1b+x];			// lda square1_lo,x	; 4
	//sm2b:
	a+=(~(square2_lo[sm2b+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;

	_cc=a;					// sta _cc+1		; 3
	//sm3b:
	a=square1_hi[sm3b+x];			// lda square1_hi,x	; 4
	//sm4b:
	a+=(~(square2_hi[sm4b+x]))+c;		// sbc square2_hi,x	; 4
	c=!!(a&0x100);
	a&=0xff;
	_CC=a;					// sta _CC+1		; 3

	/* Perform <T1 * >T2 = BBbb */
	x=(y_i)&0xff;				// ldx T2+1		; 3
	c=1;					// sec			; 2
	//sm5a:
	a=square1_lo[sm5a+x];			// lda square1_lo,x	; 4
	//sm6a:
	a+=(~(square2_lo[sm6a+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_bb=a;					// sta _bb+1		; 3
	//	printf("\t\t\t\tbb=%x c=%d\n",_bb,c);
	//sm7a:
	a=square1_hi[sm7a+x];			// lda square1_hi,x	; 4
	//sm8a:
	a+=(~(square2_hi[sm8a+x]))+c;		// sbc square2_hi,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_BB=a;					// sta _BB+1

	/* Perform >T1 * >T2 = DDdd */
	c=1;					// sec			; 2
	//sm5b:
	a=square1_lo[sm5b+x];			// lda square1_lo,x	; 4
	//sm6b:
	a+=(~(square2_lo[sm6b+x]))+c;		// sbc square2_lo,x	; 4
	c=!(a&0x100);
	a&=0xff;
	_dd=a;					// sta _dd+1		; 3
	//sm7b:
//	a=square1_hi[sm7b+x];			// lda square1_hi,x	; 4
	//sm8b:
//	a+=(~(square2_hi[sm8b+x]))+c;		// sbc square2_hi,x	; 4
//	c=!(a&0x100);
//	a&=0xff;

//	product[3]=a;				// sta PRODUCT+3	; 3
//	_DD=a;

	/*********************************************/
	/* Add the separate multiplications together */
	/*********************************************/

	// product[0]=_aa;
	//	if (debug) printf("product[0]=0.%02x\n",_aa);

	// product[1]=_AA+_bb+(_cc)
	if (debug) printf("product[1]=%02x+%02x+0=",_AA,_bb);

	c=0;					// clc			; 2
	//_AA:
	a=_AA;					// lda #0		; 2
	//_bb:
	a+=(c+_bb);				// adc #0		; 2
	c=!!(a&0x100);
	a&=0xff;
	product[1]=a;				// sta PRODUCT+1	; 3
	if (debug) printf("%x.%02x\n",c,a);

	// product[2]=_BB+_CC+c
	if (debug) printf("product[2]=%02x+%02x+%d=",_BB,_CC,c);
	//_BB:
	a=_BB;					// lda #0		; 2
	//_CC:
	a+=(c+_CC);				// adc #0		; 2
	c=!!(a&0x100);
	a&=0xff;
	product[2]=a;				// sta PRODUCT+2	; 3
	if (debug) printf("%x.%02x\n",c,a);

	// product[3]=_DD+c
//	if (debug) printf("product[3]=%02x+%d=",_DD,c);
//	if (c==0) goto urgh2;			// bcc :+		; 2nt/3
//	product[3]++;				// inc PRODUCT+3	; 5
//	product[3]&=0xff;
	c=0;					// clc			; 2
//urgh2:
//	if (debug) printf("%x.%02x\n",c,product[3]);
	// product[1]=_AA+_bb+_cc
//	if (debug) printf("product[1]=%02x+%02x+%d=",product[1],_cc,c);
	//_cc:
	a=_cc;					// lda #0		; 2
	a+=c+product[1];			// adc PRODUCT+1	; 3
	c=!!(a&0x100);
	a&=0xff;
	product[1]=a;				// sta PRODUCT+1	; 3
	if (debug) printf("%x.%02x\n",c,product[1]);

	// product[2]=_BB+_CC+_dd+c
	if (debug) printf("product[2]=%02x+%02x+%d=",product[2],_dd,c);
	//_dd:
	a=_dd;					// lda #0		; 2
	a+=c+product[2];			// adc PRODUCT+2	; 3
	c=!!(a&0x100);
	a&=0xff;
	product[2]=a;				// sta PRODUCT+2	; 3
	if (debug) printf("%x.%02x\n",c,product[2]);

	// product[3]=_DD+c
//	if (debug) printf("product[3]=%02x+%d=",product[3],c);
//	if (c==0) goto urgh;			// bcc :+		; 2nt/3
//	product[3]++;				// inc PRODUCT+3	; 5
//	product[3]&=0xff;
//urgh:
//	if (debug) printf("%x.%02x\n",c,product[3]);

	//	printf("Result=%02x:%02x\n",*z_i,*z_f);

//	if (debug) {
//		printf("    AAaa        %02x:%02x\n",_AA,_aa);
//		printf("  BBbb       %02x:%02x\n",_BB,_bb);
//		printf("  CCcc       %02x:%02x\n",_CC,_cc);
//		printf("DDdd      %02x:%02x\n",_DD,_dd);
//	}

//	return 0;
//(product[3]<<24)|(product[2]<<16)|(product[1]<<8)|product[0];
						// rts			; 6
//}

/* signed */
//int fixed_mul(int x_i,int x_f,
//		int y_i, int y_f,
//		int *z_i, int *z_f,
//			int debug) {

//	int a,c;

//	fixed_mul_unsigned(x_i,x_f,y_i,y_f,debug);
					// jsr multiply_16bit_unsigned	; 6

	a=(x_i&0xff);			// lda T1+1			; 3
	if ((a&0x80)==0) goto x_positive;	// bpl :+		; 3/2nt
	if (debug) printf("Before:   %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

	c=1;				// sec				; 2
	a=product[2];			// lda PRODUCT+2		; 3
	a+=(~y_f)+c;			// sbc T2+0			; 3
	c=!(a&0x100);
	a&=0xff;
	product[2]=a;			// sta PRODUCT+2		; 3
//	a=product[3];			// lda PRODUCT+3		; 3
//	a+=(~y_i)+c;			// sbc T2+1			; 3
//	c=!(a&0x100);
//	a&=0xff;
//	product[3]=a;			// sta PRODUCT+3		; 3
	if (debug) printf("After:    %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

x_positive:

	a=(y_i&0xff);				// lda T2+1			; 3
	if ((a&0x80)==0) goto y_positive;	// bpl :+		; 3/2nt

	if (debug) printf("Before:   %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

	c=1;				// sec				; 2
	a=product[2];			// lda PRODUCT+2		; 3
	a+=(~x_f)+c;			// sbc T1+0			; 3
	c=!(a&0x100);
	a&=0xff;
	product[2]=a;			// sta PRODUCT+2		; 3
//	a=product[3];			// lda PRODUCT+3		; 3
//	a+=(~x_i)+c;			// sbc T1+1			; 3
//	c=!(a&0x100);
//	a&=0xff;
//	product[3]=a;			// sta PRODUCT+3		; 3

	if (debug) printf("After:    %02x:%02x:%02x:%02x\n",product[3],product[2],product[1],product[0]);

y_positive:
	*z_i=product[2];
	*z_f=product[1];

//	return (product[3]<<24)|(product[2]<<16)|(product[1]<<8)|product[0];
	return 0;
						// rts			; 6
}

#endif

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

	int a_i,b_i,c_i;
	int a_f,b_f,c_f;
//	short x,y;
	int l,k,i,j;

	printf("Some tests\n");
#if 0
	x=-32768;
	y=3;

	a_i=x>>8;
	a_f=x&0xff;
	b_i=y>>8;
	b_f=y&0xff;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d\n",k);
	}

	a_i=0x0;
	a_f=0x7;

	b_i=0x0;
	b_f=0x9;

	x=7;
	y=9;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d (0x%x)\n",k,k);
	}

	a_i=0x0;
	a_f=0x2;

	b_i=0x0;
	b_f=0x3;

	x=2;
	y=3;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d (0x%x)\n",k,k);
	}

	a_i=0xff;
	a_f=0xff;

	b_i=0xff;
	b_f=0xff;

	x=0xffff;
	y=0xffff;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d (0x%x)\n",k,k);
	}

	a_i=0xff;
	a_f=0xff;

	b_i=0x00;
	b_f=0x01;

	x=0xffff;
	y=0x1;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d (0x%x)\n",k,k);
	}

	a_i=0x00;
	a_f=0xff;

	b_i=0x00;
	b_f=0x01;

	x=0xff;
	y=0x1;

	printf("\tTrying %d*%d=%d (0x%x)\n",x,y,x*y,x*y);
	k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
	if (k!=x*y) {
		printf("\t\tError! got %d (0x%x)\n",k,k);
		exit(1);
	}
	else {
		printf("\t\tProperly calculated %d (0x%x)\n",k,k);
	}

	for(i=-32768;i<32768;i++) {
		for(j=-32768;j<32768;j++) {
			a_i=i>>8;
			a_f=i&0xff;
			b_i=j>>8;
			b_f=j&0xff;

			k=fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);

			if (k!=i*j) {
				printf("WRONG! %x*%x = %x not %x\n",
					i,j,i*j,k);
				printf("       %d * %d = %d not %d\n",i,j,i*j,k);
				exit(1);
			}
		}
		if (i%256==0) printf("%x\n",i);
	}
#endif

	for(i=-32768;i<32768;i++) {
		for(j=-32768;j<32768;j++) {
			a_i=i>>8;
			a_f=i&0xff;
			b_i=j>>8;
			b_f=j&0xff;

			fixed_mul(a_i,a_f,b_i,b_f,&c_i,&c_f,0);
			k=((i*j)>>8)&0xffff;
			l=(c_i<<8)|(c_f);

			if (k!=l) {
				printf("WRONG! %x*%x = %x, %x not %02x:%02x\n",
					i,j,i*j,k,c_i,c_f);
				printf("       %d * %d = %d not %d\n",i,j,l,k);
				exit(1);
			}
		}
		if (i%256==0) printf("%x\n",i);
	}


	return 0;
}