#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "pico/stdlib.h"
#include "./read_gps.h"
#include "./screen_utils.h"

void show_coordenates_on_lcd(GPSData data) {
    char lat_buffer[40];
    char lon_buffer[40];

    sprintf(lat_buffer, "Lat: %.5f", data.latitude);
    sprintf(lon_buffer, "Lon: %.5f", data.longitude);

    print_text_on_screen(lat_buffer, 100, 5, 2);
    print_text_on_screen(lon_buffer, 120, 5, 2);
}

int main() {
    stdio_init_all();
    init_display();
    setup_gps();

    while (true) {
        GPSData data = read_gps();

        if (data.valid_data) {
            printf("Dados GPS Válidos: LAT=%.6f, LON=%.6f, FixQ=%d\n",
                   data.latitude, data.longitude, data.fix_quality);

            show_coordenates_on_lcd(data);
        }

        sleep_ms(500);
    }

    return 0;
}