diff --git a/LinActuatorTasks.c b/LinActuatorTasks.c index 2378afe..8b34446 100644 --- a/LinActuatorTasks.c +++ b/LinActuatorTasks.c @@ -576,8 +576,8 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, "Sending a command (BROADCAST): LIN_ACT_CFR_MOD (ADR = %d MODE = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].MODE) + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].MODE) #endif ret = CFR_MOD_x(env->linIo, env->linData, env->linCommandActuator[0].BUS_ADR | 0x20, env->linCommandActuator[0].MODE); @@ -585,16 +585,17 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if (ret == LIN_TX_COMPLETED) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, - "Command completed successfully (BROADCAST): LIN_ACT_CFR_MOD (ADR = %d MODE = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].MODE) + "Command completed successfully (BROADCAST): LIN_ACT_CFR_MOD (ADR = %d MODE = %d)", + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].MODE) #endif setState20(env, false, 0); } else { #if (LOG_LIN_ACTUATOR == 1) - LoggerFormatInfo(LOGGER, LOG_SIGN, "Command failed (BROADCAST) [%d]: LIN_ACT_CFR_MOD (ADR = %d MODE = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].MODE) + LoggerFormatInfo(LOGGER, LOG_SIGN, + "Command failed (BROADCAST) [%d]: LIN_ACT_CFR_MOD (ADR = %d MODE = %d)", + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].MODE) #endif setState20(env, true, 0); } @@ -605,8 +606,8 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if (env->linCommandActuator[0].COM == LIN_ACT_CFR_INI) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, "Sending a command (BROADCAST): LIN_ACT_CFR_INI (ADR = %d POS = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].POS) + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].POS) #endif ret = CFR_INI_x(env->linIo, env->linData, env->linCommandActuator[0].BUS_ADR | 0x20, @@ -615,16 +616,16 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if (ret == LIN_TX_COMPLETED) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, - "Command completed successfully (BROADCAST): LIN_ACT_CFR_INI (ADR = %d POS = %d)", - env->linCommandActuator[0].BUS_ADR, env->linCommandActuator[0].POS) + "Command completed successfully (BROADCAST): LIN_ACT_CFR_INI (ADR = %d POS = %d)", + env->linCommandActuator[0].BUS_ADR, env->linCommandActuator[0].POS) #endif setState20(env, false, 0); } else { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, "Command failed (BROADCAST): LIN_ACT_CFR_INI (ADR = %d POS = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].POS) + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].POS) #endif setState20(env, true, 0); } @@ -636,15 +637,15 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if (env->linCommandActuator[0].COM == LIN_ACT_CFR_SET) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, - "Sending a command (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].POS, - env->linCommandActuator[0].Stall_SET, - env->linCommandActuator[0].Lnoise_SET, - env->linCommandActuator[0].Autos_SET, - env->linCommandActuator[0].Speed_SET, - env->linCommandActuator[0].Coils_Stop_SET - ) + "Sending a command (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].POS, + env->linCommandActuator[0].Stall_SET, + env->linCommandActuator[0].Lnoise_SET, + env->linCommandActuator[0].Autos_SET, + env->linCommandActuator[0].Speed_SET, + env->linCommandActuator[0].Coils_Stop_SET + ) #endif ret = CFR_SET_x(env->linIo, env->linData, env->linCommandActuator[0].BUS_ADR | 0x20, @@ -658,29 +659,29 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if (ret == LIN_TX_COMPLETED) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, - "Command completed successfully (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].POS, - env->linCommandActuator[0].Stall_SET, - env->linCommandActuator[0].Lnoise_SET, - env->linCommandActuator[0].Autos_SET, - env->linCommandActuator[0].Speed_SET, - env->linCommandActuator[0].Coils_Stop_SET) + "Command completed successfully (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].POS, + env->linCommandActuator[0].Stall_SET, + env->linCommandActuator[0].Lnoise_SET, + env->linCommandActuator[0].Autos_SET, + env->linCommandActuator[0].Speed_SET, + env->linCommandActuator[0].Coils_Stop_SET) #endif setState20(env, false, 0); } else { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, - "Command failed (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", - env->linCommandActuator[0].BUS_ADR, - env->linCommandActuator[0].POS, - env->linCommandActuator[0].Stall_SET, - env->linCommandActuator[0].Lnoise_SET, - env->linCommandActuator[0].Autos_SET, - env->linCommandActuator[0].Speed_SET, - env->linCommandActuator[0].Coils_Stop_SET - ) + "Command failed (BROADCAST): LIN_ACT_CFR_SET (ADR = %d POS = %d STALL= %d LNOISE = %d AUTOS = %d SPEED = %d COILS = %d)", + env->linCommandActuator[0].BUS_ADR, + env->linCommandActuator[0].POS, + env->linCommandActuator[0].Stall_SET, + env->linCommandActuator[0].Lnoise_SET, + env->linCommandActuator[0].Autos_SET, + env->linCommandActuator[0].Speed_SET, + env->linCommandActuator[0].Coils_Stop_SET + ) #endif setState20(env, true, 0); @@ -880,9 +881,6 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { if ((env->linCommandActuator[i].COM == LIN_ACT_CFR_NONE) || (env->linCommandActuator[i].COM == LIN_ACT_CFR_SUCCESSFUL) || (env->linCommandActuator[i].isRFR_STA)) { - env->linCommandActuator[i].isRFR_STA = 0; - - uint8_t BUS_ADR = 0; uint16_t CPOS_ALL = 0; eEmrf_Slave_STA Emrf_Slave = 0; @@ -923,7 +921,9 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { (env->linStateActuator[BUS_ADR].Error2_Communication_Slave != Error2_Communication_Slave) || (env->linStateActuator[BUS_ADR].Error3_Temperature_Slave != Error3_Temperature_Slave) || (env->linStateActuator[BUS_ADR].Error4_Permanent_Electrical_Slave != - Error4_Permanent_Electrical_Slave)) { + Error4_Permanent_Electrical_Slave) || + (env->linCommandActuator[BUS_ADR].isRFR_STA) + ) { #if (LOG_LIN_ACTUATOR == 1) LoggerFormatInfo(LOGGER, LOG_SIGN, "State: ADR = %d CPOS = %d Emrf = %d Mode = %d Err1 = %d Err2 = %d Err3 = %d Err4 = %d", @@ -975,7 +975,7 @@ static lin_event_id_t Lin_Scheduler(tLinTaskActuator *env, char *LOG_SIGN) { env->linStateActuator[i].error_connect = 1; } - + env->linCommandActuator[i].isRFR_STA = 0; } // } else {