#include <stdio.h>
#include "HAL.h"
#include "System/Version.h"
#include "MillisTaskManager/MillisTaskManager.h"

#ifdef _WIN32
#include <windows.h>
#include <time.h>
#define millis        clock
#else
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#define millis        xTaskGetTickCount
#endif

static MillisTaskManager taskManager;

#if CONFIG_SENSOR_ENABLE

static void HAL_Sensor_Init()
{
#if CONFIG_SENSOR_IMU_ENABLE
    IMU_Init();
#endif

#if CONFIG_SENSOR_MAG_ENABLE
    MAG_Init();
#endif
}

#endif

// static void HAL_TimerInterrputUpdate()
// {

// }

void HAL_Init()
{
    printf("Config_Init\n");
    Config_Init();
    printf("SD_Init\n");
    SD_Init();
    printf("Power_Init\n");
    Power_Init();
    printf("Button_Init\n");
    Button_Init();

#if CONFIG_SENSOR_ENABLE
    HAL_Sensor_Init();
#endif

#ifndef _WIN32
    ShellSupport_Init();
#endif

    taskManager.Register(Power_Update, 1000);
    taskManager.Register(Button_Update, 10);
    taskManager.Register(IMU_Update, 10);
//  taskManager.Register(MAG_Update, 10);
}

void HAL_Update(uint32_t tick)
{
    taskManager.Running(tick);
}