Изменены интерфейсы UDS (добавлено управление актуаторами)
This commit is contained in:
parent
eec3afb2b7
commit
60dd9a1a09
187
Model_Task.c
187
Model_Task.c
|
|
@ -577,192 +577,6 @@ static bool setActuatorBusy(tModelTask *env) {
|
|||
return false;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
static bool setActuatorBusy(tModelTask *env) {
|
||||
|
||||
|
||||
if (env->triggerCommand1 == false) {
|
||||
|
||||
|
||||
for (uint8_t i = 0; i < env->linTaskActuator1->LIN_ISSR_ALL; ++i) {
|
||||
if (Actuator_Ch0_Command_Model.COM[i] != 0) {
|
||||
|
||||
env->triggerCommand1 = true;
|
||||
|
||||
memcpy(&env->triggerActuatorCmdBus_1, &Actuator_Ch0_Command_Model, sizeof(ActuatorCmdBus));
|
||||
|
||||
#if (LOG_LIN_ACTUATOR == 1)
|
||||
#if (LOG_LIN1_ACTUATOR == 1)
|
||||
for (uint8_t j = 0; j < env->linTaskActuator1->LIN_ISSR_ALL; ++j) {
|
||||
switch (Actuator_Ch0_Command_Model.COM[j]) {
|
||||
case LIN_ACT_CFR_MOD: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN1 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_MOD (SET BUSY)", j,
|
||||
Actuator_Ch0_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
case LIN_ACT_CFR_INI: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN1 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_INI (SET BUSY)", j,
|
||||
Actuator_Ch0_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_SET: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN1 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_SET (SET BUSY)", j,
|
||||
Actuator_Ch0_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_NONE: {
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
default: {
|
||||
LoggerFormatError(LOGGER, LOG_SIGN,
|
||||
"LIN1 (ADR[%d] = %d): TRIGGERED COMMAND = %d UNKNOWN !!! (SET BUSY)",
|
||||
j,
|
||||
Actuator_Ch0_Command_Model.BUS_ADR[j],
|
||||
Actuator_Ch0_Command_Model.COM[j])
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
Actuator_Ch0_Status_Model.Busy = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
if (env->triggerCommand2 == false) {
|
||||
|
||||
for (uint8_t i = 0; i < env->linTaskActuator2->LIN_ISSR_ALL; ++i) {
|
||||
if (Actuator_Ch1_Command_Model.COM[i] != 0) {
|
||||
|
||||
env->triggerCommand2 = true;
|
||||
|
||||
memcpy(&env->triggerActuatorCmdBus_2, &Actuator_Ch1_Command_Model, sizeof(ActuatorCmdBus));
|
||||
|
||||
#if (LOG_LIN_ACTUATOR == 1)
|
||||
#if (LOG_LIN2_ACTUATOR == 1)
|
||||
|
||||
for (uint8_t j = 0; j < env->linTaskActuator2->LIN_ISSR_ALL; ++j) {
|
||||
switch (Actuator_Ch1_Command_Model.COM[j]) {
|
||||
case LIN_ACT_CFR_MOD: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN2 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_MOD (SET BUSY)", j,
|
||||
Actuator_Ch1_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
case LIN_ACT_CFR_INI: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN2 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_INI (SET BUSY)", j,
|
||||
Actuator_Ch1_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_SET: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN2 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_SET (SET BUSY)", j,
|
||||
Actuator_Ch1_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_NONE: {
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
default: {
|
||||
LoggerFormatError(LOGGER, LOG_SIGN,
|
||||
"LIN2 (ADR[%d] = %d): TRIGGERED COMMAND = %d UNKNOWN !!! (SET BUSY)",
|
||||
j,
|
||||
Actuator_Ch1_Command_Model.BUS_ADR[j],
|
||||
Actuator_Ch1_Command_Model.COM[j])
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
Actuator_Ch1_Status_Model.Busy = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
if (env->triggerCommand3 == false) {
|
||||
|
||||
for (uint8_t i = 0; i < env->linTaskActuator3->LIN_ISSR_ALL; ++i) {
|
||||
if (Actuator_Ch2_Command_Model.COM[i] != 0) {
|
||||
|
||||
env->triggerCommand3 = true;
|
||||
|
||||
memcpy(&env->triggerActuatorCmdBus_3, &Actuator_Ch2_Command_Model, sizeof(ActuatorCmdBus));
|
||||
|
||||
#if (LOG_LIN_ACTUATOR == 1)
|
||||
#if (LOG_LIN3_ACTUATOR == 1)
|
||||
|
||||
for (uint8_t j = 0; j < env->linTaskActuator3->LIN_ISSR_ALL; ++j) {
|
||||
switch (Actuator_Ch2_Command_Model.COM[j]) {
|
||||
case LIN_ACT_CFR_MOD: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN3 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_MOD (SET BUSY)", j,
|
||||
Actuator_Ch2_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
case LIN_ACT_CFR_INI: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN3 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_INI (SET BUSY)", j,
|
||||
Actuator_Ch2_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_SET: {
|
||||
LoggerFormatTrace(LOGGER, LOG_SIGN,
|
||||
"LIN3 (ADR[%d] = %d): TRIGGERED COMMAND LIN_ACT_CFR_SET (SET BUSY)", j,
|
||||
Actuator_Ch2_Command_Model.BUS_ADR[j])
|
||||
break;
|
||||
}
|
||||
|
||||
case LIN_ACT_CFR_NONE: {
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
default: {
|
||||
LoggerFormatError(LOGGER, LOG_SIGN,
|
||||
"LIN3 (ADR[%d] = %d): TRIGGERED COMMAND = %d UNKNOWN !!! (SET BUSY)",
|
||||
j,
|
||||
Actuator_Ch2_Command_Model.BUS_ADR[j],
|
||||
Actuator_Ch2_Command_Model.COM[j])
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
#endif
|
||||
|
||||
Actuator_Ch2_Status_Model.Busy = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
return false;
|
||||
}
|
||||
*/
|
||||
|
||||
__attribute__((section(".save_data"))) volatile CmdCAN_CCU_STAT1_Bus CCU_STAT1_MODEL_SAVE;
|
||||
__attribute__((section(".save_data"))) volatile CmdCAN_CCU_STAT2_Bus CCU_STAT2_MODEL_SAVE;
|
||||
__attribute__((section(".save_data"))) volatile CmdCAN_CCU_STAT3_Bus CCU_STAT3_MODEL_SAVE;
|
||||
|
|
@ -1118,7 +932,6 @@ static _Noreturn void ModelTask_Thread(tModelTask *env) {
|
|||
|
||||
set_Dtc_state(env->diagnostic);
|
||||
|
||||
|
||||
CanUdsInput_Set_Model(env->canUds);
|
||||
|
||||
env->isRunning = true;
|
||||
|
|
|
|||
Loading…
Reference in New Issue