//
// Created by cfif on 15.12.2025.
//
#include "AdcTasks.h"
#include "CmsisRtosThreadUtils.h"
#include <SystemDelayInterface.h>
#include "memory.h"

void Adc_0_Init(tAdcTask *env,
                tAdcIO *adcIO,
                tGpios *gpios) {

    env->adcIO = adcIO;
    env->access = osMutexNew(NULL);

    env->gpios = gpios;

    InitThreadAtrStatic(&env->thread.attr, "Adc0", env->thread.controlBlock, env->thread.stack,
                        osPriorityNormal);
}


static _Noreturn void Adc0_Thread(tAdcTask *env) {

    uint32_t ADC_Pointer_Data;

    for (;;) {

        env->ADC_ChannelCount = env->adcIO->get(env->adcIO->env, &ADC_Pointer_Data, 1000);

        if (osMutexAcquire(env->access, 1000) == osOK) {

            uint32_t *pData = (uint32_t *) ADC_Pointer_Data;

            env->ADC0_Data.Sensor_Ambient_Temp = pData[0];
            env->ADC0_Data.IGN_ANS = pData[1];
            env->ADC0_Data.Sensor_AC_Pressure = pData[2];
            env->ADC0_Data.Sensor_Incar_Temp_FL = pData[3];
            env->ADC0_Data.Sensor_Incar_Temp_RL = pData[4];
            env->ADC0_Data.Sensor_Rear_Evap_Temp = pData[5];
            env->ADC0_Data.Sensor_Evap_Temp = pData[6];
            env->ADC0_Data.Sensor_Rear_Duct1 = pData[7];
            env->ADC0_Data.Sensor_Rear_Duct2 = pData[8];
            env->ADC0_Data.Sensor_Front_Duct1 = pData[9];
            env->ADC0_Data.Sensor_Front_Duct2 = pData[10];
            env->ADC0_Data.Sensor_Front_Duct3 = pData[11];
            env->ADC0_Data.Sensor_Front_Duct4 = pData[12];
            env->ADC0_Data.Sensor_Rear_Duct3 = pData[13];
            env->ADC0_Data.Sensor_Rear_Duct4 = pData[14];
            env->ADC0_Data.Sensor_Incar_Temp_FR = pData[15];
            env->ADC0_Data.Sensor_Incar_Temp_RR = pData[16];
            env->ADC0_Data.Sensor_Rear_Duct5 = pData[17];
            env->ADC0_Data.Sensor_Rear_Duct6 = pData[18];
            env->ADC0_Data.Reserve_Sensor_Duct_Temp_1 = pData[19];
            env->ADC0_Data.Sensor_Front_Duct5 = pData[20];
            env->ADC0_Data.Sensor_Front_Duct6 = pData[21];

            env->ADC0_Data.Pressure_DIAG = pData[23];
            env->ADC0_Data.Reserve_Sensor_Duct_Temp_2 = pData[28];

            if (env->ADC0_BTS5120_2EKA_Channel == 0) {
                env->ADC0_BTS5120_2EKA_Channel = 1;

                GpioPinSet(&env->gpios->power.BTS5120_2EKA_ShutoffValvePowerTXV.ShutSelTXV_SEL_Diag, true);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_ShutOFFValveFrontRear.ShutSel_SEL_Diag, true);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_TwoWayValveAndReservePowerSupply.TwoWayValve_SEL_Diag, true);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_FrontRearIncarMotor.Incar_SEL_Diag, true);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_2xChannelPTCPower.PtcRelayDriver_SEL_Diag, true);


                env->ADC0_Data.BTS5120_2EKA_ShutoffValvePowerTXV1 = pData[22]; //
                env->ADC0_Data.BTS5180_2EKA_ShutOFFValveFront = pData[24]; //
                env->ADC0_Data.BTS5180_2EKA_TwoWayValve = pData[25]; //
                env->ADC0_Data.BTS5180_2EKA_FrontIncarMotor = pData[26]; //
                env->ADC0_Data.BTS5180_2EKA_ChannelPTCPower1 = pData[27]; //
            } else {
                env->ADC0_BTS5120_2EKA_Channel = 0;

                GpioPinSet(&env->gpios->power.BTS5120_2EKA_ShutoffValvePowerTXV.ShutSelTXV_SEL_Diag, false);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_ShutOFFValveFrontRear.ShutSel_SEL_Diag, false);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_TwoWayValveAndReservePowerSupply.TwoWayValve_SEL_Diag, false);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_FrontRearIncarMotor.Incar_SEL_Diag, false);
                GpioPinSet(&env->gpios->power.BTS5180_2EKA_2xChannelPTCPower.PtcRelayDriver_SEL_Diag, false);

                env->ADC0_Data.BTS5120_2EKA_ShutoffValvePowerTXV2 = pData[22]; //
                env->ADC0_Data.BTS5180_2EKA_ShutOFFValveRear = pData[24]; //
                env->ADC0_Data.BTS5180_2EKA_ReservePowerSupply = pData[25]; //
                env->ADC0_Data.BTS5180_2EKA_RearIncarMotor = pData[26]; //
                env->ADC0_Data.BTS5180_2EKA_ChannelPTCPower2 = pData[27]; //

                env->ADC_isUpdate = true;
            }


            //memcpy(env->ADC_Data, (uint8_t *)ADC_Pointer_Data, env->ADC_ChannelCount << 2);

            osMutexRelease(env->access);
        }

        SystemDelayMs(10);
    }
}

void Adc_0_StartThread(tAdcTask *env) {
    if (!env->thread.id) {
        env->thread.id = osThreadNew((osThreadFunc_t) (Adc0_Thread), (void *) (env), &env->thread.attr);
    }
}


void Adc_1_Init(tAdcTask *env,
                tAdcIO *adcIO,
                tGpios *gpios) {

    env->adcIO = adcIO;
    env->access = osMutexNew(NULL);
    env->gpios = gpios;

    InitThreadAtrStatic(&env->thread.attr, "Adc1", env->thread.controlBlock, env->thread.stack,
                        osPriorityNormal);
}


static _Noreturn void Adc1_Thread(tAdcTask *env) {

    uint32_t ADC_Pointer_Data;

    for (;;) {

        env->ADC_ChannelCount = env->adcIO->get(env->adcIO->env, &ADC_Pointer_Data, 1000);

        if (osMutexAcquire(env->access, 1000) == osOK) {

            //memcpy(env->ADC_Data, (uint8_t *)ADC_Pointer_Data, env->ADC_ChannelCount << 2);
            uint32_t *pData = (uint32_t *) ADC_Pointer_Data;

            env->ADC1_Data.VN7008AJ_DIAG_FrontLINActuatorPowerDriverAB = pData[0];
            env->ADC1_Data.VN7008AJ_DIAG_RearLINActuatorPowerDriverC = pData[1];
            env->ADC1_Data.PBATT_CHECK = pData[2];
            env->ADC1_Data.VN7008AJ_FrontLINActuatorPowerDriverAB = pData[3];
            env->ADC1_Data.VN7008AJ_RearLINActuatorPowerDriverC = pData[4];

            env->ADC_isUpdate = true;

            osMutexRelease(env->access);
        }

        SystemDelayMs(10);
    }
}

void Adc_1_StartThread(tAdcTask *env) {
    if (!env->thread.id) {
        env->thread.id = osThreadNew((osThreadFunc_t) (Adc1_Thread), (void *) (env), &env->thread.attr);
    }
}