#include "fxlib.h"
#include "MonochromeLib.h"
#include "math.h"

//****************************************************************************
//  AddIn_main (Sample program main function)
//
//  param   :   isAppli   : 1 = This application is launched by MAIN MENU.
//                        : 0 = This application is launched by a strip in eACT application.
//
//              OptionNum : Strip number (0~3)
//                         (This parameter is only used when isAppli parameter is 0.)
//
//  retval  :   1 = No error / 0 = Error
//
//****************************************************************************
int AddIn_main(int isAppli, unsigned short OptionNum)
{
    double PI = 3.1415926535897932;
    double r = 0, angleCam = 0, camX = 2, camY = 4, distRayon = 0, angleRayon = 0, distMur = 0;
    int murX, murY, ray = 0;
    unsigned int key;

    int map[7] [21] =
    {{1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1},
    {1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1},
    {1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1},
    {1,0,0,0,0,0,0,0,1,1,0,0,0,0,0,0,0,0,0,0,1},
    {1,0,0,0,0,0,0,0,1,1,0,0,0,0,0,0,0,0,0,0,1},    
    {1,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1},
    {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1}};

    ML_clear_vram();

    do{
    ML_clear_vram();
    ML_clear_screen();

    //Calculs de deplacements
    camX = camX+r*(cos(angleCam));
    camY = camY+r*(sin(angleCam));
    r = 0;
    
    //Personnage
    locate(camX, camY);
    Print((unsigned char*)"+");
    
    //Rayons de detection
    ray = 0;
    for(angleRayon = angleCam-(1.0/6*PI); angleRayon<angleCam+(1.0/6*PI); angleRayon = angleRayon+0.0082)
    {
        ray++;
        for(distRayon = 0; distRayon<=20; distRayon++)
        {
            murX = (int) (distRayon*cos(angleRayon)+camX);
            murY = (int) (distRayon*sin(angleRayon)+camY);

            if(map[murY] [murX] == 1)
            {
                distMur = sqrt(pow((distRayon*cos(angleRayon)+camX)-camX, 2)+pow(    (distRayon*sin(angleRayon)+camY)-camY, 2));
                ML_line(ray, (int) ((63/distMur)+31), ray, (int) ((-63/distMur)+31), ML_BLACK);      //Cette commande bug
                break;
            }
        }
    }

    ML_display_vram();

    GetKey(&key);

    //Commandes
    if(key == KEY_CTRL_UP && map[(int) (1*sin(angleCam)+camY)] [(int) (1*cos(angleCam)+camX)] != 1)
    {
        r++;
    }
    if(key == KEY_CTRL_DOWN && map[(int) (-1*sin(angleCam)+camY)] [(int) (-1*cos(angleCam)+camX)] != 1)
    {
        r--;
    }
    if(key == KEY_CTRL_LEFT)
    {
        angleCam = angleCam-(1.0/12*PI);
    }
    if(key == KEY_CTRL_RIGHT)
    {
        angleCam = angleCam+(1.0/12*PI);
    }

    }while (key != KEY_CTRL_EXIT);
    
    return 1;
}