156 lines
5.9 KiB
C
156 lines
5.9 KiB
C
//
|
|
// 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);
|
|
}
|
|
} |