/** YARY
*   Yet Another Raycast Implementation
*   2.5D retrogame engine
*   https://github.com/monade/yari
*/

#define ESP32
#define YARI_MAIN
#define YARI_NO_PREFIX
#include <yari.h>

#define COLS 20
#define ROWS 20

#define PLAYER_ROTATION_SPEED 2
#define PLAYER_SPEED 4.5
#define PLAYER_COLLISION_THRESHOLD 0.15f

// 0 null, 1-127 texture_id, 128-255 color_id
static uint8_t map[ROWS][COLS] = {0};
int joystick_id = 0;


void init_map() {
    // border
    for (int i = 0; i < ROWS; i++) {
        map[i][0] = YR_WALL_GREEN;
        map[i][COLS - 1] = YR_WALL_GREEN;
    }
    for (int j = 0; j < COLS; j++) {
        map[0][j] = YR_WALL_GREEN;
        map[ROWS - 1][j] = YR_WALL_GREEN;
    }

    // inner blocks
    map[7][7] = YR_WALL_RED;
    map[8][8] = YR_WALL_BLUE;
    map[9][9] = YR_WALL_YELLOW;
}

void move_player(GameState *state) {
    Camera *p = &state->camera;
    float joy_x = esp_joystick_get_axis(joystick_id, YR_X_AXIS);
    float joy_y = esp_joystick_get_axis(joystick_id, YR_Y_AXIS);
    if (is_key_down(YR_KEY_A) || joy_x < -0.15f) {
        p->dir = rotate(p->dir, YR_COUNTERCLOCKWISE, PLAYER_ROTATION_SPEED);
    }
    if (is_key_down(YR_KEY_D) || joy_x > 0.15f) {
        p->dir = rotate(p->dir, YR_CLOCKWISE, PLAYER_ROTATION_SPEED);
    }

    Vector2 target = p->pos;
    if (is_key_down(YR_KEY_W) || joy_y > 0.15f) target = move(target, p->dir, YR_FORWARD, PLAYER_SPEED);
    if (is_key_down(YR_KEY_S) || joy_y < -0.15f) target = move(target, p->dir, YR_BACK, PLAYER_SPEED);
    if (is_key_down(YR_KEY_E)) target = move(target, p->dir, YR_RIGHT, PLAYER_SPEED);
    if (is_key_down(YR_KEY_Q)) target = move(target, p->dir, YR_LEFT, PLAYER_SPEED);

    p->pos = slide_collision(state, p->pos, target, NULL, PLAYER_COLLISION_THRESHOLD, YR_CMSK_ALL);
}


// Main game functions
void yr_init_game(GameState *state) {
  init_map();
  state->map = (uint8_t *)map;
  state->map_cols = COLS;
  state->map_rows = ROWS;
  state->camera = (Camera){.pos = {14.5, 5.5}, .dir = {-0.8, 0.5}};

  esp_key_init(26, YR_KEY_W);
  esp_key_init(25, YR_KEY_A);
  esp_key_init(15, YR_KEY_S);
  esp_key_init(2, YR_KEY_D);
  joystick_id = esp_joystick_init(32, 36);
}

void yr_update_game(GameState *state) {
    draw_game();
    move_player(state);
}