//
// Created by misaki on 2025/8/23.
//

#include <esp_log.h>


#include "I2C_Driver.h"
#include "QMI8658.h"
extern IMUdata Accel;
extern IMUdata Gyro;
void imu_test(void)
{
    I2C_Init();
    QMI8658_Init();
    while (1) {
        QMI8658_Loop();
        ESP_LOGI("app_main", "Accel x: %f, y: %f, z: %f", Accel.x, Accel.y, Accel.z);
        ESP_LOGD("app_main", "Gyro X: %f, Y: %f, Z: %f", Gyro.x, Gyro.y, Gyro.z);
    }
}

#include "BAT_Driver.h"
void battery_test(void)
{
    // 初始化电池驱动
    BAT_Init();

    while(1) {
        float voltage = BAT_Get_Volts();
        ESP_LOGI("BAT_TEST", "Battery Voltage: %.2f V", voltage);

        // 电池状态判断
        if (voltage > 4.0) {
            ESP_LOGI("BAT_TEST", "Battery Status: Full");
        } else if (voltage > 3.7) {
            ESP_LOGI("BAT_TEST", "Battery Status: Good");
        } else if (voltage > 3.4) {
            ESP_LOGI("BAT_TEST", "Battery Status: Low");
        } else {
            ESP_LOGI("BAT_TEST", "Battery Status: Critical");
        }
    }

}