/*
 ===================================================================================
	Cygne SDL  v 2.1a      (c) Caz, Niels Wagenaar 2002     niels@nwagenaar.demon.nl
 ===================================================================================

   NEC cpu core  by Bryan McPhail,Oliver Bergmann, Fabrice Frances and David Hedley
   Zlib  by  Jean-loup Gailly and Mark Adler

 ===================================================================================
 SDL Drawing, Scanlines/Double Mode etc
 ===================================================================================
*/

#include <SDL.h>
#include "globals.h"
#include "gfx.h"

#define k_m 13
#define k_w 15
#define k_s 29

SDL_Surface *g_pDDSPrimary = NULL;

DWORD						dx_bits,dx_pitch,cmov,dx_linewidth_blit,dx_buffer_line;
DWORD						dx_r,dx_g,dx_b,dx_sr,dx_sg,dx_sb;
DWORD						dx_r_old,dx_g_old,dx_b_old;
BYTE						dx_buffer[224*144*4];

BYTE header[54]={
66,77,54,122,1,0,0,0,0,0,54,0,
0,0,40,0,0,0,144,0,0,0,224,0,
0,0,1,0,24,0,0,0,0,0,0,122,
1,0,0,0,0,0,0,0,0,0,0,0,
0,0,0,0,0,0};


BYTE BMPTab[224*144*4];


DWORD filecount=0;
int vmodel=0;

void screenshot(void)
{
	BYTE br,bg,bb;
	BYTE d0,d1,d2,d3;
	DWORD add=0;
	DWORD mucho;
	
	unsigned long maxy,maxx;
	if(!vmodel)
	{
		header[0x12]=0xe0;
		header[0x16]=0x90;
		maxx=224;
		maxy=144;
	}
	else
	{
		header[0x12]=0x90;
		header[0x16]=0xe0;
		maxy=224;
		maxx=144;
	}
	char fname[256];
	sprintf(fname,"SCR%.5ld.bmp",filecount++);
	FILE* fil=fopen(fname,"wb");
	fwrite(header,1,54,fil);
	
	unsigned long xx,yy;
	for(yy=0;yy<maxy;yy++)
	for(xx=0;xx<maxx;xx++)
	{
		
	
		if(dx_bits==2)
		{
			d0=dx_buffer[add++];
			d1=dx_buffer[add++];
			mucho=d0|(d1<<8);
		}
		else
		{
			d0=dx_buffer[add++];
			d1=dx_buffer[add++];
			d2=dx_buffer[add++];
			d3=dx_buffer[add++];
			mucho=d0|(d1<<8)|(d2<<16)|(d3<<24);
		}

		br=((mucho&dx_r_old)>>dx_sr)<<(8-dx_r);
		bg=((mucho&dx_g_old)>>dx_sg)<<(8-dx_g);
		bb=((mucho&dx_b_old)>>dx_sb)<<(8-dx_b);

		BMPTab[(xx+(maxy-yy-1)*maxx)*3]=bb;
		BMPTab[(xx+(maxy-yy-1)*maxx)*3+1]=bg;
		BMPTab[(xx+(maxy-yy-1)*maxx)*3+2]=br;
	}
	fwrite(BMPTab,1,224*144*3,fil);

	fclose(fil);
}

void set_shades (void)
{
	  DWORD		red,green,blue;
	  int		i;
	  
  	  switch(wsShades)
	  {
		case 0:
			for (i=0;i<16;i++)
			{
				red=(i*k_w+k_s)>>(8-dx_r);
				green=(i*k_w+k_s)>>(8-dx_g);
				blue=(i*k_w+k_s)>>(8-dx_b);
				colors[i]=(red<<dx_sr)|(green<<dx_sg)|(blue<<dx_sb);
			}
		break;
		case 1:
			for (i=0;i<16;i++)
			{
				red=(i*k_w+k_s)>>(8-dx_r);
				green=(i*k_m+k_s)>>(8-dx_g);
				blue=(i*k_m+k_s)>>(8-dx_b);
				colors[i]=(red<<dx_sr)|(green<<dx_sg)|(blue<<dx_sb);
			}
		break;
		case 2: 
			for (i=0;i<16;i++)
			{
				red=(i*k_m+k_s)>>(8-dx_r);
				green=(i*k_m+k_s)>>(8-dx_g);
				blue=(i*k_w+k_s)>>(8-dx_b);
				colors[i]=(red<<dx_sr)|(green<<dx_sg)|(blue<<dx_sb);
			}
		break;
		case 3:
			for (i=0;i<16;i++)
			{
				red=(i*k_m+k_s)>>(8-dx_r);
				green=(i*k_w+k_s)>>(8-dx_g);
				blue=(i*k_m+k_s)>>(8-dx_b);
				colors[i]=(red<<dx_sr)|(green<<dx_sg)|(blue<<dx_sb);
			}
		break;
	 }		
}


DWORD find1(DWORD data)
{
	DWORD	res=0;
	if(!data)  return 0;
	while(1) {  if(data&1)	return res;  data>>=1;  res++; }
}
				
DWORD count1(DWORD data)
{
	DWORD	res=0;
	for(int i=0;i<32;i++) {  if(data&1)   res++;  data>>=1; }
	return res;
}

void closedx(void)
{
	if(g_pDDSPrimary !=NULL) {
		SDL_FreeSurface(g_pDDSPrimary);
		g_pDDSPrimary = NULL;
	}
}

void UpdateFrame_h()
{
	switch(fBlitterMode) {
		case 1:
			__asm__ __volatile__(".align 32\n\t"
							"cld\n\t"
							"rep\n\t"
							"movsw"
							 :
							 :"S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"((g_pDDSPrimary->h * g_pDDSPrimary->pitch)>>1));
		break;
		case 2:
			__asm__ __volatile__("pusha\n\t"
								"xorl %%eax, %%eax\n\t"
								"movl $448, %%ebx\n\t"
								"emms\n\t"
								"sum:\n\t"
								"movq (%0, %%eax, 1), %%mm0\n\t"
								"movq %%mm0, %%mm1\n\t"
								"punpcklwd %%mm0, %%mm0\n\t"
								"addl $8, %%eax\n\t"
								"punpckhwd %%mm1,%%mm1\n\t"
								"movq %%mm0, -16(%1, %%eax, 2)\n\t"
								"cmpl %%ebx, %%eax\n\t"
								 
								"movq %%mm1, -8(%1, %%eax, 2)\n\t"
								"jnz sum\n\t"
								"xorl %%eax, %%eax\n\t"
								 
								"addl %2, %0\n\t"
								"decl %%edx\n\t"
								 
								"leal (%1, %2, 4), %1\n\t"
								"jnz sum\n\t"
								"emms\n\t"
								"popa"
			:
			: "S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"(g_pDDSPrimary->pitch>>1), "d"(144));
		break;
		
		case 3:
			__asm__ __volatile__("pusha\n\t"
								"xorl %%eax, %%eax\n\t"
								"movl $896, %%ebx\n\t"
								"emms\n"
								"sum3:\n\t"
								"movq (%0, %%eax, 1), %%mm0\n\t"
								"movq %%mm0, %%mm1\n\t"
								"punpcklwd %%mm0, %%mm0\n\t"
								"addl $8, %%eax\n\t"
								"punpckhwd %%mm1,%%mm1\n\t"
								"movq %%mm0, -16(%1, %%eax, 2)\n\t"
								"cmpl %%ebx, %%eax\n\t"
								"\n\t"
								"movq %%mm1, -8(%1, %%eax, 2)\n\t"
								"jnz sum3\n\t"
								"xorl %%eax, %%eax\n\t"
								"\n\t"
								"addl %2, %0\n\t"
								"decl %%edx\n\t"
								"\n\t"
								"leal (%1, %2, 4), %1\n\t"
								"jnz sum3\n\t"
								"emms\n\t"
								"popa"
			:
			: "S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"(g_pDDSPrimary->pitch>>1), "d"(144));
		break;
	}
	//Niels(adjust to suit) use the asm below, or use standard memcpy/fast_memcpy etc, updateframe_v is not implemented
	// just do the same there SDL_Flip/memcpy shit
	
	//memcpy(g_pDDSPrimary->pixels, dx_buffer, g_pDDSPrimary->h * g_pDDSPrimary->pitch);
	 //__asm__ __volatile__ ("emms
//						  	
//						    loop2:
//						    movl %1, %%eax
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 //1
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 2
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 3
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0  //4
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0  // 5
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 6
//							
//						    movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 7
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 8
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 9
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 10
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 11
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 12
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							leal 32(%1), %1
//							leal 32(%0), %0 // 13
//							
//							movq (%0), %%mm0
//						  	movq 8(%0), %%mm1
//						   	movq 16(%0), %%mm2
//						   	movq 24(%0), %%mm3
//						  	movq %%mm0, (%1)
//						   	movq %%mm1, 8(%1)
//							movq %%mm2, 16(%1)
//							movq %%mm3, 24(%1)
//							
//							leal 32(%0), %0
//							movl %%eax, %1
//							
//							leal (%1, %3, 0), %1
//							decl %%ecx
//							jnz loop2
//						   emms
//						   
//						   "
//						:
//						: "S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"(144), "d"(dx_linewidth_blit));
	
	SDL_Flip(g_pDDSPrimary);
}

void UpdateFrame_v()
{
	switch(fBlitterMode) {
		case 1:
			__asm__ __volatile__(".align 32\n\t"
							"cld\n\t"
							"rep\n\t"
							"movsw"
							 :
							 :"S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"((g_pDDSPrimary->h * g_pDDSPrimary->pitch)>>1));
		break;
		case 2: // double scanlines
			__asm__ __volatile__("pusha\n\t"
								"xorl %%eax, %%eax\n\t"
								"movl $288, %%ebx\n\t"
								"emms\n"
								"sumb:\n\t"
								"movq (%0, %%eax, 1), %%mm0\n\t"
								"movq %%mm0, %%mm1\n\t"
								"punpcklwd %%mm0, %%mm0\n\t"
								"addl $8, %%eax\n\t"
								"punpckhwd %%mm1,%%mm1\n\t"
								"movq %%mm0, -16(%1, %%eax, 2)\n\t"
								"cmpl %%ebx, %%eax\n\t"
								"\n\t"
								"movq %%mm1, -8(%1, %%eax, 2)\n\t"
								"jnz sumb\n\t"
								"xorl %%eax, %%eax\n\t"
								"\n\t"
								"addl %2, %0\n\t"
								"decl %%edx\n\t"
								"\n\t"
								"leal (%1, %2, 4), %1\n\t"
								"jnz sumb\n\t"
								"emms\n\t"
								"popa"
			:
			: "S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"(g_pDDSPrimary->pitch>>1), "d"(224));
		break;
		case 3: // double stretch mode
			__asm__ __volatile__("pusha\n\t"
								"xorl %%eax, %%eax\n\t"
								"movl $576, %%ebx\n\t"
								"emms\n"
								"sumc:\n\t"
								"movq (%0, %%eax, 1), %%mm0\n\t"
								"movq %%mm0, %%mm1\n\t"
								"punpcklwd %%mm0, %%mm0\n\t"
								"addl $8, %%eax\n\t"
								"punpckhwd %%mm1,%%mm1\n\t"
								"movq %%mm0, -16(%1, %%eax, 2)\n\t"
								"cmpl %%ebx, %%eax\n\t"
								"\n\t"
								"movq %%mm1, -8(%1, %%eax, 2)\n\t"
								"jnz sumc\n\t"
								"xorl %%eax, %%eax\n\t"
								"\n\t"
								"addl %2, %0\n\t"
								"decl %%edx\n\t"
								"\n\t"
								"leal (%1, %2, 4), %1\n\t"
								"jnz sumc\n\t"
								"emms\n\t"
								"popa"
			:
			: "S"(dx_buffer), "D"(g_pDDSPrimary->pixels), "c"(g_pDDSPrimary->pitch>>1), "d"(224));
		break;
	}
	SDL_Flip(g_pDDSPrimary);
}

int start_dx_h(void)
{
	if(g_pDDSPrimary != NULL) {
		SDL_FreeSurface(g_pDDSPrimary);
		g_pDDSPrimary = NULL;
	}
		
	g_pDDSPrimary = SDL_SetVideoMode(224 * fScreenSize, 144 * fScreenSize, 16, SDL_SWSURFACE);
	memset(g_pDDSPrimary->pixels, 0, g_pDDSPrimary->pitch * g_pDDSPrimary->h);
	
	SDL_WM_SetCaption("Cygne", NULL);
	if(!g_pDDSPrimary) {
		puts("error");
		return 1;
	}
	
	dx_bits = g_pDDSPrimary->format->BitsPerPixel;
	dx_r = g_pDDSPrimary->format->Rmask;
	dx_g = g_pDDSPrimary->format->Gmask;
	dx_b = g_pDDSPrimary->format->Bmask;
	
	//if(g_pDDScanner != NULL) {
	//	SDL_FreeSurface(g_pDDScanner);
	//	g_pDDScanner = NULL;
	//}
	
	//if(fBlitterMode)
	//		g_pDDScanner = SDL_CreateRGBSurface(SDL_SWSURFACE, 224, 144,
	//						16, dx_r, dx_g, dx_b, 0);
		
	
	dx_pitch=g_pDDSPrimary->pitch;
	cmov=g_pDDSPrimary->pitch/4;
	dx_bits/=8;
	dx_sr=find1(dx_r);
	dx_sg=find1(dx_g);
	dx_sb=find1(dx_b);

	dx_r_old=dx_r;
	dx_g_old=dx_g;
	dx_b_old=dx_b;


	dx_r=count1(dx_r);
	dx_g=count1(dx_g);
	dx_b=count1(dx_b);
	
	dx_linewidth_blit=g_pDDSPrimary->pitch;
	dx_buffer_line=61*dx_bits;
	set_shades();
	return	0;
}

int start_dx_v(void)
{
	if(g_pDDSPrimary != NULL) {
		SDL_FreeSurface(g_pDDSPrimary);
		g_pDDSPrimary = NULL;
	}
	
	g_pDDSPrimary = SDL_SetVideoMode(144*fScreenSize, 224*fScreenSize, 16, SDL_SWSURFACE);
	
	memset(g_pDDSPrimary->pixels, 0, g_pDDSPrimary->pitch * g_pDDSPrimary->h);
	SDL_WM_SetCaption("Cygne", NULL);
	if(!g_pDDSPrimary) {
		puts("error");
		return 1;
	}

	dx_bits = g_pDDSPrimary->format->BitsPerPixel;
	dx_r = g_pDDSPrimary->format->Rmask;
	dx_g = g_pDDSPrimary->format->Gmask;
	dx_b = g_pDDSPrimary->format->Bmask;
	
	dx_pitch=g_pDDSPrimary->pitch;
	cmov=g_pDDSPrimary->pitch/4;
	dx_bits/=8;
	dx_sr=find1(dx_r);
	dx_sg=find1(dx_g);
	dx_sb=find1(dx_b);
	
	dx_r_old=dx_r;
	dx_g_old=dx_g;
	dx_b_old=dx_b;

	dx_r=count1(dx_r);
	dx_g=count1(dx_g);
	dx_b=count1(dx_b);
	dx_linewidth_blit=g_pDDSPrimary->pitch;
	dx_buffer_line=61*dx_bits;
	set_shades();
	return 0;
}

int start_dx(void)
{
	if(flipd)
	 return start_dx_v();
    else
	 return start_dx_h();
}

void UpdateFrame(int i)
{
	vmodel=i;
	
	if(i)
		UpdateFrame_v();
	else
		UpdateFrame_h();
}

void flip_screen(void)
{
	flipd^=1;
	closedx();
	//set_size(1);
	start_dx();
	fr=0;
}