#include <stdio.h>

#include "espressif/esp_common.h"
#include "esp/uart.h"

#include "FreeRTOS.h"
#include "task.h"

#include "bmp280/bmp280.h"


const uint8_t scl_pin = 5;
const uint8_t sda_pin = 4;


static void bmp280_task(void *pvParameters)
{
    bmp280_params_t  params;
    float pressure, temperature;

    bmp280_init_default_params(&params);
    while (1) {
        while (!bmp280_init(&params, scl_pin, sda_pin)) {
            printf("BMP280 initialization failed\n");
            vTaskDelay(1000 / portTICK_RATE_MS);
        }

        while(1) {
            vTaskDelay(1000 / portTICK_RATE_MS);
            if (!bmp280_read(&temperature, &pressure)) {
                printf("Temperature/pressure reading failed\n");
                break;
            }
            printf("Pressure: %.2f Pa, Temperature: %.2f C\n", pressure, temperature);
        }
    }
}

void user_init(void)
{
    uart_set_baud(0, 115200);

    // Just some information
    printf("\n");
    printf("SDK version : %s\n", sdk_system_get_sdk_version());
    printf("GIT version : %s\n", GITSHORTREV);

    xTaskCreate(bmp280_task, (signed char *)"bmp280_task", 256, NULL, 2, NULL);
}