#include <fxcg/display.h>
#include <fxcg/keyboard.h>
#include <math.h>


void main(void) {

    // PrintXY(3, 1, "", TEXT_MODE_NORMAL, TEXT_COLOR_RED); // Place it somewhere on the screen
    
    double r = 0;
    double camera_angle = 0;
    double player_x = 0;
    double player_y = 0;
    double ray_distance = 0;
    double ray_angle = 0;
    double wall_dist = 0;
    double wall_height_1 = 0;
    double wall_height_2 = 0;
    double cursor = 0;

    int map[20][20] = {
        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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
        1,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,1,
    };

    Bdisp_AllClr_VRAM();

    while (1) {

        // deplacements
        player_x = player_x + r * (cos(camera_angle));
        player_y = player_y + r * (cos(camera_angle));
        r = 0;


        cursor = 0;
        for (ray_angle = camera_angle - 30; ray_angle < camera_angle + 300; ray_angle = ray_angle + 0.47) {
            cursor++;
            for (ray_distance = 0; ray_distance < 30; ray_distance++) {

                if (map[ (int) (ray_distance * (double) sin(ray_angle) + player_y)][ (int) (ray_distance * (double) cos(ray_angle) + player_x)] == 1) {

                    wall_dist = (double) sqrt((double) pow (ray_distance * (double) cos(ray_angle), 2) + (double) pow (ray_distance * (double) sin(ray_angle), 2));
                    wall_height_1 = (60 / wall_dist) + 30;
                    wall_height_2 = (-60 / wall_dist) + 30;

                    Bdisp_SetPoint_DD(cursor, wall_height_1, 0x0000); //to complete
                }

            }

        }

    }
    

    return;
}

projet_1.o: In function `_main':
projet_1.c:(.text.startup+0x154): undefined reference to `_memset'
projet_1.c:(.text.startup+0x290): undefined reference to `_sin'
projet_1.c:(.text.startup+0x298): undefined reference to `_cos'
projet_1.c:(.text.startup+0x2a4): undefined reference to `_sqrt'
collect2: ld returned 1 exit status
make[1]: *** [C:/Users/mkowalski/Desktop/PrizmSDK-0.3/projects/projet_1/projet_1.bin] Error 1
make: *** [build] Error 2