#include <stdio.h>
#include "pico/stdlib.h"
#include "hardware/gpio.h"
#include "pico/binary_info.h"

#include "gyro.h"

const uint LED_PIN = 25;

int main() {
    bi_decl(bi_program_description("This is a test binary."));
    bi_decl(bi_1pin_with_name(LED_PIN, "On-board LED"));

    stdio_init_all();

    gpio_init(LED_PIN);
    gpio_set_dir(LED_PIN, GPIO_OUT);
    gpio_put(LED_PIN, 1);

    sleep_ms(3000);

    Gyro_Init();

    while (1) { 
        u_int16_t step_ms = 100;
        /*gpio_put(LED_PIN, 0);
        sleep_ms(251);
        gpio_put(LED_PIN, 1);
        puts("Bonjour");
        sleep_ms(1000);*/
        sleep_ms(step_ms);
        Gyro_Read(step_ms);
    }
}