#include <stdio.h>
#include <string.h>
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "freertos/queue.h"
#include "driver/uart.h"
#include "esp_log.h"
#include "esp_debug_helpers.h"
#include "nvs_flash.h"
#include "esp_vfs_dev.h"

#include "main.h"
#include "lorcomm.h"
#include "esp32-lora.h"
#include "console.h"
#include "ble.h"
#include "user_button.h"

static const char *TAG = "loracom-main";

lora32_cfg_t lora;
uint8_t mac[6];

static void handle_lora_txdone() {
  lora32_enable_continuous_rx(&lora);
}

void handle_lora_caddone(bool detected) {
  //ESP_LOGI(TAG, "CAD done: detected? %s", detected ? "true" : "false");

  if(detected) {
    lora32_enable_cad(&lora);
  } else {
    ESP_LOGI(TAG, "candone (no channel activity): enabling continuous RX");

    lora32_enable_continuous_rx(&lora);
  }
}

void app_main(void) {
  esp_err_t err = nvs_flash_init();
  if (err == ESP_ERR_NVS_NO_FREE_PAGES || err == ESP_ERR_NVS_NEW_VERSION_FOUND) {
      ESP_ERROR_CHECK(nvs_flash_erase());
      err = nvs_flash_init();
  }
  ESP_ERROR_CHECK( err );

  nvs_handle_t nvs_handle;
  err = nvs_open("config", NVS_READWRITE, &nvs_handle);
  if (err != ESP_OK) {
    printf("Error (%s) opening NVS handle!\n", esp_err_to_name(err));
  } else {
    lorcomm_cfg.nvs_handle = nvs_handle;
    ESP_LOGI(TAG, "nvs_handle: %d", nvs_handle);
  }

  esp_efuse_mac_get_default((uint8_t*)&mac);

  ESP_LOGI(TAG, "MAC: [%02X:%02X:%02X:%02X:%02X:%02X]", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);

  lora.bandwidth = B125;
  lora.codingRate = 5;
  lora.frequency = 915000000;
  lora.spreadingFactor = 11;
  lora.preamble = DEFAULT_PREAMBLE;
  lora.dio0 = CONFIG_LORA32_DIO0_PIN;
  lora.implicitHeader = false;
  lora.nss = CONFIG_LORA32_NSS_PIN;
  lora.reset = CONFIG_LORA32_RESET_PIN;
  lora.useCRC = false;
  lora.fifoIdx = 0;
  lora.receive = &lorcomm_handle_receive;
  lora.tx_done = &handle_lora_txdone;
  //lora.cad_done = &handle_lora_caddone;
  //lora.cad_detected = &handle_lora_caddetected;

  lora32_init(&lora);

  //double dr = lora32_calc_datarate(&lora);
  //ESP_LOGI(TAG, "data rate: %fbps", dr);

  lora32_dump_regs(&lora);

  lorcomm_cfg.lora = &lora;

  xTaskCreate(console_task, "console", 4048, &lorcomm_cfg, tskIDLE_PRIORITY + 3, NULL);

  //ble_init();

  lora32_enable_continuous_rx(&lora);

#ifdef CONFIG_LORCOMM_BUTTON_ACTION_ENABLED
  user_button_init();
#endif

  while(1) {
    vTaskDelay(1000 / portTICK_PERIOD_MS);
  }
}