#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "freertos/event_groups.h"
#include "esp_wifi.h"
#include "esp_log.h"
#include "esp_event.h"
#include "nvs_flash.h"

// FreeRTOS event group to signal Wi-Fi events
static EventGroupHandle_t wifi_event_group;
const int WIFI_CONNECTED_BIT = BIT0;

// Event handler for WiFi events
static void wifi_event_handler(void* arg, esp_event_base_t event_base,
                               int32_t event_id, void* event_data) {
  if (event_base == WIFI_EVENT && event_id == WIFI_EVENT_STA_START) {
    esp_wifi_connect();
  } else if (event_base == WIFI_EVENT && event_id == WIFI_EVENT_STA_DISCONNECTED) {
    printf("Disconnected from Wi-Fi\n");
    xEventGroupClearBits(wifi_event_group, WIFI_CONNECTED_BIT);
  } else if (event_base == IP_EVENT && event_id == IP_EVENT_STA_GOT_IP) {
    ip_event_got_ip_t* event = (ip_event_got_ip_t*) event_data;
    printf("Got IP: \n" IPSTR, IP2STR(&event->ip_info.ip));
    xEventGroupSetBits(wifi_event_group, WIFI_CONNECTED_BIT);
  }
}

void wifi_connect() {
  printf("Starting Wi-Fi...\n");
  esp_wifi_start();

  // Wait for connection
  EventBits_t bits = xEventGroupWaitBits(wifi_event_group, WIFI_CONNECTED_BIT,
                                         pdFALSE, pdTRUE, pdMS_TO_TICKS(10000));
  if (bits & WIFI_CONNECTED_BIT) {
    printf("Wi-Fi connected\n");
  } else {
    printf("Failed to connect to Wi-Fi\n");
    esp_wifi_stop(); // Stop Wi-Fi if unable to connect
  }
}

void wifi_disconnect() {
  printf("Stopping Wi-Fi...\n");
  esp_wifi_disconnect();
  esp_wifi_stop();    // Stops the Wi-Fi driver
  esp_wifi_deinit();  // De-initialize the Wi-Fi driver
  printf("Wi-Fi stopped\n");
}

void app_main(void) {
  printf("esp-idf: %s\n", esp_get_idf_version());

  // Initialize NVS
  esp_err_t ret = nvs_flash_init();
  if (ret == ESP_ERR_NVS_NO_FREE_PAGES || ret == ESP_ERR_NVS_NEW_VERSION_FOUND) {
    ESP_ERROR_CHECK(nvs_flash_erase());
    ESP_ERROR_CHECK(nvs_flash_init());
  }

  wifi_event_group = xEventGroupCreate();

  // Initialize TCP/IP stack and WiFi
  ESP_ERROR_CHECK(esp_netif_init());
  ESP_ERROR_CHECK(esp_event_loop_create_default());
  esp_netif_create_default_wifi_sta();

  // Register event handlers
  esp_event_handler_instance_t instance_any_id;
  esp_event_handler_instance_t instance_got_ip;
  ESP_ERROR_CHECK(esp_event_handler_instance_register(WIFI_EVENT,
                  ESP_EVENT_ANY_ID,
                  &wifi_event_handler,
                  NULL,
                  &instance_any_id));
  ESP_ERROR_CHECK(esp_event_handler_instance_register(IP_EVENT,
                  IP_EVENT_STA_GOT_IP,
                  &wifi_event_handler,
                  NULL,
                  &instance_got_ip));

  while (true) {
    printf("-----------------\n");
    printf("Total free heap: %ld\n", esp_get_free_heap_size());

    wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
    ESP_ERROR_CHECK(esp_wifi_init(&cfg));

    wifi_config_t wifi_config = {
      .sta = {
        .ssid = "Wokwi-GUEST",
        .password = "",
        .channel = 6,
      },
    };

    ESP_ERROR_CHECK(esp_wifi_set_mode(WIFI_MODE_STA));
    ESP_ERROR_CHECK(esp_wifi_set_config(ESP_IF_WIFI_STA, &wifi_config));

    wifi_connect();
    vTaskDelay(pdMS_TO_TICKS(1000));

    wifi_disconnect();
    vTaskDelay(pdMS_TO_TICKS(1000));

    printf("\n");
    printf("\n");
  }
}