#include <iostream>
#include <SDL.h>
#include "polygon.h"
#include "viewer.h"
#include "sys.h"
using namespace std;

#define redMask   0x00ff0000
#define greenMask 0x0000ff00
#define blueMask  0x000000ff
#define alphaMask 0

extern int create_sgp(Polygon *sg, SceneGraphPack *sgp);
extern int update_sgp(SceneGraphPack *sgp, SceneGraphPack *_sgp);
extern int create_pp(SceneGraphPack *sgp, PolygonPack *pp);

Viewer::Viewer(int b, int w, int h)
{
    bpp = b;
    width = w;
    height = h;
}


void Viewer::sdl_init()
{
    if (SDL_Init( SDL_INIT_VIDEO ) < 0) {
	fprintf(stderr,"Couldn't initialize SDL: %s\n",SDL_GetError());
	exit( 1 );
    }

#ifndef _DEBUG
    screen = SDL_SetVideoMode( width, height, bpp, SDL_HWSURFACE);
    if (screen == NULL) {
	fprintf(stderr, "Couldn't set GL mode: %s\n", SDL_GetError());
	SDL_Quit();
	exit(1);
    }
#else
    void *_pixels = new Uint32[width*height*32/8];
    //posix_memalign(&pixels, width*heigh/8, DEFAULT_ALIGNMENT);
    screen = SDL_CreateRGBSurfaceFrom(_pixels, width, height, 32,
				      width*4, redMask, greenMask,
				      blueMask, alphaMask);
#endif
}


int Viewer::get_ticks()
{
    int time;
    time = SDL_GetTicks();
    return time;
}

bool Viewer::quit_check()
{
    bool quit = false;
    SDL_Event event;
    while(SDL_PollEvent(&event))
    {
	if(event.type==SDL_QUIT)
	{
	    quit = true;
	    return quit;
	}
    }
    return quit;
}

void Viewer::quit()
{
    SDL_Quit();
}


void Viewer::swap_buffers()
{
    SDL_GL_SwapBuffers();
}


void
Viewer::write_pixel(int x, int y,float z, Uint32 rgb)
{
    SDL_PixelFormat *pf;
    pf = screen->format;
    x += width/2;
    y += height/2;

    static int diffz,diffz1;

    diffz1 = diffz;
    diffz = (zRow[x][y]>z);
    if (z < zRow[x][y]) { 
	if (x < width && x > 0 && y > 0 && y < height) {
	    zRow[x][y] = z;
	    y = height - y;
	    pixels[width*y + x] = rgb;
	}
    }
}

void
Viewer::write_line(float x1, float y1, float x2, float y2, Uint32 rgb)
{
    if (x1 > x2) {
	float x=0;
	float y=0;
	x=x1;
	y=y1;
	x1 = x2;
	y1 = y2;
	x2 = x;
	y2 = y;
    }

    float s = y1;

    if ((int)x1 == (int)x2) {
	if (y1 > y2) {
	    float y=0;
	    y = y1;
	    y1 = y2;
	    y2 = y;
	}

	for (float i=y1; i<y2; i++) {
	    //write_pixel((int)x1,(int)i);
	    write_pixel((int)x1,(int)i,0,rgb);
	}
    } else {
	float t = (y2 - y1)/(x2 - x1);
	if (t < -1) {
	    float f = 0;
	    for (float i=x1; i<x2; i++) {
		for (float a=(int)t; a<0; a++) {
		    write_pixel((int)i,(int)s,0,rgb);
		    s--;
		}

		f += t-(int)t;

		if (f <= -1) {
		    write_pixel((int)i,(int)s,0,rgb);
		    f = 0;
		    s--;
		}
	    }
	} else if (t <= 1) {
	    for(float i=x1; i<x2; i++) {
		//write_pixel((int)i,(int)s);
		write_pixel((int)i,(int)s,0,rgb);
		s += t;
	    }
	} else {
	    float f = 0;
	    for (float i=x1; i<x2; i++) {
		for (float a=0; a<(int)t; a++) {
		    write_pixel((int)i,(int)s,0,rgb);
		    s++;
		}

		f += t-(int)t;

		if (f >= 1) {
		    write_pixel((int)i,(int)s,0,rgb);
		    f = 0;
		    s++;
		}
	    }
	}
    }
}

void Viewer::write_triangle(float x1, float y1, float x2, float y2, float x3, float y3, Uint32 rgb)
{
    write_line(x1,y1,x2,y2,rgb);
    write_line(x2,y2,x3,y3,rgb);
    write_line(x3,y3,x1,y1,rgb);
}

void Viewer::clean_pixels()
{
    for(int i=0; i<width*height; i++)
    {
	pixels[i] = 0x00;
    }
}

void Viewer::graph_line()
{
    int xl = width*height/2;
    int yl = width/2;
    for(int i=0; i<width; i++)
    {
	for(int t=0; t<height; t+=20)
	{
	    pixels[width*t+i] = 0x5a;
	}
	pixels[xl +i] = 0xff;
    }
    for(int i=0; i<height; i++)
    {
	for(int t=0; t<width; t+=20)
	{
	    pixels[i*width+t] = 0x5a;
	}
	pixels[i*width+yl] = 0xff;
    }
}

// run_arg_t に書くのがめんどいからって
// global に書くのもどうか
int start_time;
int this_time;
int frames;
SDL_Surface *bitmap;
SDL_PixelFormat *pixelFormat;
Uint32 background;
Polygon *polygon;
SceneGraphPack *sgp;
PolygonPack *pp;    
//DmaBuffer *sgp_buff __attribute__((aligned(DEFAULT_ALIGNMENT)));
//DmaBuffer *pp_buff __attribute__((aligned(DEFAULT_ALIGNMENT)));

void
Viewer::run_init()
{
    HTaskPtr task;
    int fd;

    SceneGraphPack *sgp;

    start_time = get_ticks();
    this_time  = 0;
    frames     = 0;

    pixelFormat = screen->format;
    background  = SDL_MapRGB(screen->format, 0x00, 0x00, 0x00);
    polygon     = new Polygon;
    polygon->set_data("cube.xml");
    polygon->viewer  = this;

#if 0
    // 通信用 buffer の allocate 
    // これじゃないと通信用に使えない(ように処理を書かないと！)
    sgp_buff = manager->allocate(sizeof(SceneGraphPack));

    sgp_buff->get_buffer(&sgp);
    create_sgp(polygon, sgp);
    sgp_buff->swap_buffer();

    sgp_buff->get_buffer(&sgp);
    create_sgp(polygon, sgp);
    sgp_buff->swap_buffer();

    pp_buff = manager->allocate(sizeof(PolygonPack));
#else
    sgp = new SceneGraphPack;
    create_sgp(polygon, sgp);   

    pp = new PolygonPack;
#endif

    pixels = new Uint32[width*height];
    
    graph_line();

    bitmap = SDL_CreateRGBSurfaceFrom((void *)pixels, width, height, 32,
				      width*4, redMask, greenMask,
				      blueMask, alphaMask);

    fd = manager->open("ViewerRunLoop");
    task = manager->create_task(fd, 0, 0, 0, NULL);      
    task->spawn();
}

void
Viewer::run_loop(void)
{
    HTaskPtr task_update_sgp = NULL;
    HTaskPtr task_create_pp = NULL;
    HTaskPtr task_finish = NULL;
    int fd_update_sgp;
    int fd_create_pp;
    int fd_finish;

    HTaskPtr task;
    int fd;

    bool quit_flg;

    quit_flg = quit_check();

    if (quit_flg == true) {
	this_time = get_ticks();
	fd_finish = manager->open("ViewerRunFinish");
	task_finish = manager->create_task(fd_finish, 0, 0, 0, NULL);
	task_finish->spawn();
	return;
    }

    clean_pixels();

    zRow_init();
    graph_line();

    fd_update_sgp = manager->open("UpdateSGP");
    fd_create_pp  = manager->open("CreatePP");
    fd = manager->open("ViewerRunDraw");
    task_update_sgp = manager->create_task(fd_update_sgp,
					   sizeof(SceneGraphPack),
					   //sgp_buff, sgp_buff, NULL);
					   (unsigned int)sgp, (unsigned int)sgp, NULL);
    task_create_pp = manager->create_task(fd_create_pp,
					  sizeof(SceneGraphPack),
					  //sgp_buff, pp_buff, NULL);
					  (unsigned int)sgp, (unsigned int)pp, NULL);
    task = manager->create_task(fd, 0, 0, 0, NULL);

    task->set_depend(task_update_sgp);
    task->set_depend(task_create_pp);
    
    //task_update_sgp->set_cpu(CPU_SPE);
    //task_create_pp->set_cpu(CPU_SPE);

    task_update_sgp->spawn();
    task_create_pp->spawn();
    task->spawn();

    //sgp_buff->swap_buffer();
}

void
Viewer::run_draw(void)
{
    HTaskPtr task;
    int fd;

    //PolygonPack *pp;

    //pp_buff->get_buffer(&pp);

    polygon->draw(pp);    // test draw of PolygonPack
    SDL_BlitSurface(bitmap, NULL, screen, NULL);
    SDL_UpdateRect(screen, 0, 0, 0, 0);    

    frames++;

    fd = manager->open("ViewerRunLoop");
    task = manager->create_task(fd, 0, 0, 0, NULL);
    task->spawn();
}

void
Viewer::run_finish(void)
{
    if (this_time != start_time) {
	cout<< (((float)frames)/(this_time-start_time))*1000.0 << " FPS\n";
    }

    SDL_FreeSurface(bitmap);
    delete [] pixels;
    polygon->delete_data();
    delete polygon;
    //delete sgp_buff;
    //delete pp_buff;
    quit();
}

void
Viewer::zRow_init()
{
    for (int i = 0; i < width; i++) {
	for (int j = 0; j < height; j++) {
	    zRow[i][j] = 65535;
	}
    }
}