#include "Main.h"
#include <Tactility/Thread.h>
#include <Tactility/TactilityCore.h>

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

#include <tactility/log.h>

constexpr auto* TAG = "FreeRTOS";

namespace simulator {

MainFunction mainFunction = nullptr;

void setMain(MainFunction newMainFunction) {
    mainFunction = newMainFunction;
}

static void freertosMainTask(void* parameter) {
    LOG_I(TAG, "starting app_main()");
    assert(simulator::mainFunction);
    mainFunction();
    LOG_I(TAG, "returned from app_main()");
    vTaskDelete(nullptr);
}

void freertosMain() {
    BaseType_t task_result = xTaskCreate(
        freertosMainTask,
        "main",
        8192,
        nullptr,
        static_cast<UBaseType_t>(tt::Thread::Priority::Normal),
        nullptr
    );

    assert(task_result == pdTRUE);

    // Blocks forever
    vTaskStartScheduler();
}

} // namespace