diff --git a/LinSensorTasks.c b/LinSensorTasks.c index 4df05bd..ae00f8c 100644 --- a/LinSensorTasks.c +++ b/LinSensorTasks.c @@ -25,7 +25,7 @@ const uint8_t DRS_SENSON_ADR_Stat[LIN5_SENSOR_COUNT] = {DRS_DL_Stat, static lin_event_id_t SEND_SENSOR_COM_x(tLinIO *linIo, uint8_t COM_ADR) { lin_event_id_t res = linIo->runCommand(linIo->env, COM_ADR, 30); - SystemDelayMs(40); +// SystemDelayMs(40); return res; } @@ -332,6 +332,31 @@ static void set_led_group(tCCU_DRS_Req *req, uint8_t led_group, uint8_t count) { static lin_event_id_t Lin5_Scheduler(tLin5TaskSensor *env) { lin_event_id_t ret = LIN_NO_EVENT; + + + for (uint8_t i = 0; i < LIN5_SENSOR_COUNT; ++i) { + set_led_group(&env->d_CCU_DRS_Req, i, env->LED_COUNT[i]); + } + env->d_CCU_DRS_Req.BCM_SwIndIntens_Stat = 1; + env->d_CCU_DRS_Req.BCM_IndFadingTime_Req = 2; + +// if (*((uint32_t *) &env->d_CCU_DRS_Req) != *((uint32_t *) &env->d_old_CCU_DRS_Req)) { +// *((uint32_t *) &env->d_old_CCU_DRS_Req) = *((uint32_t *) &env->d_CCU_DRS_Req); + ret = Set_CCU_DRS_Req(env->linIo, env->linData, &env->d_CCU_DRS_Req); + +#if (LOG_LIN5_SENSOR == 1) + if (ret == LIN_TX_COMPLETED) { + LoggerInfoStatic(LOGGER, LOG_SIGN5, "Sensor Set_CCU_DRS_Req - OK") + } else { + LoggerFormatInfo(LOGGER, LOG_SIGN5, "Sensor Set_CCU_DRS_Req (ERROR %d)", ret) + } +#endif +// } + + + + + for (uint8_t i = 0; i < LIN5_SENSOR_COUNT; ++i) { ret = Get_DRS_Stat(env->linIo, env->linData, &env->d_DRS_Stat[i], DRS_SENSON_ADR_Stat[i]); @@ -363,24 +388,6 @@ static lin_event_id_t Lin5_Scheduler(tLin5TaskSensor *env) { } - for (uint8_t i = 0; i < LIN5_SENSOR_COUNT; ++i) { - set_led_group(&env->d_CCU_DRS_Req, i, env->LED_COUNT[i]); - } - env->d_CCU_DRS_Req.BCM_SwIndIntens_Stat = 1; - env->d_CCU_DRS_Req.BCM_IndFadingTime_Req = 2; - - if (*((uint32_t *) &env->d_CCU_DRS_Req) != *((uint32_t *) &env->d_old_CCU_DRS_Req)) { - *((uint32_t *) &env->d_old_CCU_DRS_Req) = *((uint32_t *) &env->d_CCU_DRS_Req); - ret = Set_CCU_DRS_Req(env->linIo, env->linData, &env->d_CCU_DRS_Req); - -#if (LOG_LIN5_SENSOR == 1) - if (ret == LIN_TX_COMPLETED) { - LoggerInfoStatic(LOGGER, LOG_SIGN5, "Sensor Set_CCU_DRS_Req - OK") - } else { - LoggerFormatInfo(LOGGER, LOG_SIGN5, "Sensor Set_CCU_DRS_Req (ERROR %d)", ret) - } -#endif - } return LIN_NO_EVENT; }