#include <string.h>
#include "system.h"
#include "tinygl.h"
#include "task.h"
#include "navswitch.h"
#include "eeprom.h"
#include "uint8toa.h"
#include "../fonts/font3x5_1.h"
#include "pacer.h"
#include <avr/io.h>
#include "tweeter.h"
#include "mmelody.h"
#include "button.h"
#include "pio.h"
#include <stdbool.h>
#include "ir_serial.h"
#include "ir.h"

#define PACER_RATE 500
#define MESSAGE_RATE 20

static _Bool ready;
static _Bool handshake;

static void handshake_init (void)
{
    handshake = false;
}

static void ready_screen_init(void)
{
    ready = false;
}

static void ready_screen_task(void)
{
    ready = true;
}

static void tinygl_task_init(void)
{
    tinygl_font_set(&font3x5_1);
    tinygl_text_speed_set(MESSAGE_RATE);
    tinygl_text_mode_set(TINYGL_TEXT_MODE_SCROLL);
    tinygl_text_dir_set (TINYGL_TEXT_DIR_ROTATE);
}

static void show_err (uint8_t err)
{
    char buffer[3];

    buffer[0] = 'E';
    buffer[1] = err + '0';
    buffer[2] = 0;
    tinygl_text (buffer);
}

void display_character (char character)
{
    char buffer[2];

    buffer[0] = character;
    buffer[1] = '\0';
    tinygl_text (buffer);
}

static void ready_loop (void)
{
    while (1) {
        uint8_t data;
        pacer_wait();
        tinygl_update();
        ir_serial_ret_t ret;
        ir_serial_transmit (1);
        ret = ir_serial_receive (&data);
        if (ret == IR_SERIAL_OK) {
            if (data == 1) {
                ready = !ready;
                handshake = true;
            }
        } else if (ret < 0) {
            show_err (-ret);
        }
    }
}

int main (void)
{
    ready_screen_init();
    button_init();
    system_init();
    handshake_init();
    ir_serial_init();
    pacer_init (PACER_RATE);
    tinygl_init(PACER_RATE);
    tinygl_task_init();
    //Intro screen
    tinygl_text("SUPER DODGEBALL 9000");

    while(1)
    {
        pacer_wait();
        tinygl_update();
        button_update();
        //Break out of Intro screen and into the Ready loop
        if (button_push_event_p(BUTTON1) && !ready && !handshake) {
            ready_screen_task();
            tinygl_text("READY?");
            ready_loop();
        } else if (handshake && !ready) {
            display_character('A');
        }
    }
    return 0;

}