#include "fxlib.h"
#include "MonochromeLib.h"
#include "math.h"
#include "ECode.h"
#include "stdlib.h"
#include "struct.h"
#include "wall.h"
#include "syscall.h"

#define FPS 60
#define FRAME_TIME 1/FPS
Line lines[6] = {{0, NULL, 0},{1, NULL, 60},{2, NULL, 120},{3, NULL, 180},{4, NULL, 240},{5, NULL, 300}};

int player_angle=0;

Camera cam = {64, 32, 0};

Wall *list = NULL;

float dAngle = 10;

void drawPlayer();

void drawDiagonal(int nb);

int AddIn_main(int isAppli, unsigned short OptionNum)
{
    unsigned int fps = 0, frame = 0, tempsOrigine = RTC_GetTicks();
    unsigned char fps_text[8] = {0};
    srand(RTC_GetTicks());

    //list = addWall(list, 128, 8, 1, 1);

    while(KeyUp(K_EXIT)){
        //fps
        int current_frame_time = RTC_GetTicks();
        if(RTC_GetTicks() - tempsOrigine >= 32 )//1/4 seconds
        {
            fps = frame*4;
            frame = 0;
            tempsOrigine = RTC_GetTicks();
        }
        frame++;

        cam.angle = (int) (cam.angle + dAngle);
        if(cam.angle >= 360)cam.angle = cam.angle - 359;
        if(list != NULL){
            update(list);
            if(isColliding(list, player_angle) == true)
            {
                PrintMini(50, 0, "TOUCHE", MINI_OVER);
            }
            list = removeWall(list, 0);

        }
        if(rand() % 40 == 1)
        {
            list = addWall(list, 128, 8, 1, rand()%6);
        }else if(rand() % 70 == 1)
        {
            int emptyRow = rand()%6;
            int i = 0;
            for(i = 0; i < 6; i++)
                if(i != emptyRow)
                    list = addWall(list, 128, 15, 1, i);
        }
        drawPlayer();
        drawDiagonal(1);
        drawDiagonal(2);
        drawDiagonal(3);
        intToStr(fps_text, fps);
        PrintMini(0, 0, fps_text, MINI_OVER);
        intToStr(fps_text, player_angle);
        PrintMini(116, 0, fps_text, MINI_OVER);
        if(list != NULL)
            show(list, &cam);
    
        ML_display_vram();
        ML_clear_vram();
        if(KeyDown(K_LEFT))
        {
            player_angle-=15;
        }
        if(KeyDown(K_RIGHT))
        {
            player_angle+=15;
        }
        if(KeyDown(K_PLUS))
        {
            dAngle += 0.2;
        }
        if(KeyDown(K_MINUS))
        {
            dAngle -= 0.2;
        }
        if(player_angle < 0)
            player_angle = 360 + player_angle;
        player_angle = player_angle % 360;

        if(player_angle > 360)
        {
            while(KeyUp(K_EXE))
            {}
        }
        //while
        Sleep(1/0.06);
    }

    return 1;
}

void drawPlayer()
{
    int x[6];
    int y[6];
    int i = 0;

    for(i = 0; i++; i != 6)
    {
        int angle = i *60;
        x[i] = 16*cos(PI*angle/180) + cam.cX;
        y[i] = 16*sin(PI*angle/180) + cam.cY;
    }
    ML_filled_circle(cam.cX, cam.cY, 6, BLACK);
    ML_filled_circle(9*cos( PI*(player_angle + cam.angle)/180) + cam.cX, 9*sin( PI*(player_angle+cam.angle)/180) + cam.cY, 1, BLACK);
    
}

void drawDiagonal(int nb)
{
    int tmp_angle = 0;
    float coeff = 0;
    int x1 = 0, y1 = 0, x2 = 0, y2 = 0;

    if(nb == 1)
        tmp_angle = cam.angle + 60;
    else if(nb == 2)
        tmp_angle = cam.angle;
    else if(nb == 3)
        tmp_angle = 300 + cam.angle;
    if(tmp_angle >= 360)tmp_angle = tmp_angle - 359;


    coeff = sin(PI*tmp_angle / 180)/cos(PI * tmp_angle / 180);

    x1 = -32/coeff;
    y1 = -32;

    x2 = 32/coeff;
    y2 = 32;

    if(abs(x1) > 64){
        x1 = -64;
        y1 = -64*coeff;

        x2 = 64;
        y2 = 64*coeff;
    }
        ML_line(x1 + cam.cX, y1 + cam.cY, x2 + cam.cX, y2 + cam.cY, BLACK);
}

#pragma section _BR_Size
unsigned long BR_Size;
#pragma section
#pragma section _TOP
int InitializeSystem(int isAppli, unsigned short OptionNum)
{
    return INIT_ADDIN_APPLICATION(isAppli, OptionNum);
}
#pragma section