#include <stdio.h>
#include <string.h>
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "driver/gpio.h"

#include "wifi.c"
#include "mqtt.c"

#define FORWARD 21
#define RIGHT 15
#define LEFT 17
#define BACKWARD 2

char *broker = "mqtt://broker.emqx.io";

void app_main(void){

    // 🔥 ตั้งค่า LED
    gpio_set_direction(FORWARD, GPIO_MODE_OUTPUT);
    gpio_set_direction(RIGHT, GPIO_MODE_OUTPUT);
    gpio_set_direction(LEFT, GPIO_MODE_OUTPUT);
    gpio_set_direction(BACKWARD, GPIO_MODE_OUTPUT);

    wifi_connect_init();
    wifi_connect_sta("Wokwi-GUEST", "", 10000);

    mqtt_init(broker, "test/control");

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