/************************************************************************** * * Copyright (c) 2019-2020 Diality Inc. - All Rights Reserved. * * THIS CODE MAY NOT BE COPIED OR REPRODUCED IN ANY FORM, IN PART OR IN * WHOLE, WITHOUT THE EXPLICIT PERMISSION OF THE COPYRIGHT OWNER. * * @file Heaters.c * * @author (last) Quang Nguyen * @date (last) 14-Sep-2020 * * @author (original) Dara Navaei * @date (original) 23-Apr-2020 * ***************************************************************************/ #include // TODO remove if not needed // TI PWM driver #include "etpwm.h" #include "AlarmMgmt.h" #include "DGDefs.h" #include "Heaters.h" #include "InternalADC.h" #include "OperationModes.h" #include "PIControllers.h" #include "ROPump.h" #include "SafetyShutdown.h" #include "SystemCommMessages.h" #include "TaskPriority.h" #include "TemperatureSensors.h" #include "Timers.h" /** * @addtogroup Heaters * @{ */ // ********** private definitions ********** #define MAIN_PRIMARY_HEATER_MAX_DUTY_CYCLE 1.00 ///< Main primary heater (heater A) max duty cycle (100%). #define SMALL_PRIMAY_HEATER_MAX_DUTY_CYCLE 1.00 ///< Small Primary heater (heater B) max duty cycle (100%). #define TRIMMER_HEATER_MAX_DUTY_CYCLE 1.00 ///< Trimmer heater max duty cycle (100%). #define HEATERS_MIN_DUTY_CYCLE 0.00 ///< Primary and trimmer heaters minimum duty cycle (0.00%). #define PRIMARY_HEATERS_CUMULATIVE_DUTY_CYCLE ( MAIN_PRIMARY_HEATER_MAX_DUTY_CYCLE + \ SMALL_PRIMAY_HEATER_MAX_DUTY_CYCLE ) ///< Primary heaters cumulative duty cycle. #define PRIMARY_HEATER_INITIAL_DUTY_CYCLE_ESTIMATE_DIVISOR 2.0 ///< Primary heaters initial duty cycle estimation divisor. #define MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR 2.0 ///< Main and small primary heater duty cycle divisor #define PRIMARY_HEATERS_P_COEFFICIENT 0.15 // TODO remove ///< Primary heaters proportional coefficient. #define PRIMARY_HEATERS_I_COEFFICIENT 0.001 // TODO remove ///< Primary heaters integral coefficient. #define TRIMMER_HEATER_P_COEFFICIENT 0.02 // TODO remove ///< Trimmer heater proportional coefficient. #define TRIMMER_HEATER_I_COEFFICIENT 0.001 // TODO remove ///< Trimmer heater integral coefficient. #define CONTROLLER_CHECK_INTERVAL_COUNT 10U ///< Time interval count to check the PI controller. #define TEMP_SENSORS_INTERVAL_COUNT 10U ///< Temperature sensors interval count. #define HEATERS_DATA_PUBLISH_INTERVAL ( MS_PER_SECOND / TASK_PRIORITY_INTERVAL ) ///< Heaters data publish interval. #define MINIMUM_TARGET_TEMPERATURE 10.0 ///< Minimum allowed target temperature for the heaters. #define MAXIMUM_TARGET_TEMPERATURE 90.0 ///< Maximum allowed target temperature for the heaters. #define HEATERS_ON_WITH_NO_FLOW_TIMEOUT_COUNT ( ( 3 * MS_PER_SECOND ) / TASK_PRIORITY_INTERVAL ) ///< Heaters are on but there is no sufficient flow timeout in counts. #define HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_C 170.0 ///< Heaters max allowed internal temperature in C. #define HEATERS_MAX_ALLOWED_COLD_JUNCTION_TEMPERATURE_C 80.0 ///< Heaters max allowed cold junction temperature in C. #define HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_TIMEOUT_MS ( 2 * SEC_PER_MIN * MS_PER_SECOND ) ///< Heaters max allowed internal temperature timeout in milliseconds. #define HEATERS_ON_NO_FLOW_TIMEOUT_MS ( 2 * SEC_PER_MIN * MS_PER_SECOND ) ///< Heaters on with no flow time out in milliseconds. #define HEATERS_MAX_OPERATING_VOLTAGE_V 24.0 ///< Heaters max operating voltage in volts. #define HEATERS_VOLTAGE_MONITOR_TIME_INTERVAL ( MS_PER_SECOND / TASK_PRIORITY_INTERVAL ) ///< Heaters voltage monitor timer interval. #define HEATERS_MAX_VOLTAGE_OUT_OF_RANGE_TOL 0.2 ///< Heaters max voltage out of range tolerance. #define PRIMARY_HEATERS_POWER_TO_VOLTAGE_SLOPE 31.644 ///< Primary heaters power to voltage slope. #define PRIMARY_HEATERS_POWER_TO_VOLTAGE_INTERCEPT 2.0996 ///< Primary heaters power to voltage intercept. /**************************************************** New defines ***********************/ typedef enum Heaters_Exec_States { HEATER_EXEC_STATE_NOT_RUNNING = 0, ///< Heater exec state not running HEATER_EXEC_STATE_RAMP_UP_TO_TARGET, ///< Heater exec state ramp up to target HEATER_EXEC_STATE_CONTROL_TO_TARGET, ///< Heater exec state control to target NUM_OF_HEATERS_STATE, ///< Number of heaters state } HEATERS_STATE_T; typedef struct { F32 targetTemperature; ///< Heater Target temperature F32 previousTemperature; ///< Heater Previous temperature TODO do we need this anymore? HEATERS_STATE_T state; ///< Heater state TEMPERATURE_SENSORS_T feedbackSensor; ///< Heater feedback sensor for controlling U32 controlTimerCounter; ///< Heater control timer counter BOOL startHeaterSignal; ///< Heater start indication flag BOOL isHeaterOn; ///< Heater on/off status flag // TODO remove once the mechanical thermal cutoff was implemented U32 tempOutOfRangeTimer; ///< Heater temperature out of range timer BOOL isHeaterTempOutOfRange; ///< Heater temperature out of range flag indicator // TODO remove once the mechanical thermal cutoff was implemented F32 dutycycle; ///< Heater duty cycle F32 maxAllowedDutyCycle; ///< Heater maximum allowed duty cycle F32 targetROFlow; ///< Heater target flow } HEATER_STATUS_T; static HEATER_STATUS_T heaterStatus[ NUM_OF_DG_HEATERS ]; ///< Heaters status. static U32 dataPublicationTimerCounter; ///< Data publication timer counter. static OVERRIDE_U32_T heatersDataPublishInterval = { HEATERS_DATA_PUBLISH_INTERVAL, HEATERS_DATA_PUBLISH_INTERVAL, 0, 0 }; ///< Heaters data publish time interval. static U32 heatersOnWithNoFlowTimer; ///< Heaters are on but there is no sufficient flow. static BOOL isFlowBelowMin = FALSE; ///< Boolean flag to indicate if the flow is below the minimum. static U32 voltageMonitorTimeCounter = 0; ///< Heaters voltage monitor counter. // ********** private function prototypes ********** static HEATERS_STATE_T handleHeaterStateNotRunning( DG_HEATERS_T heater ); static HEATERS_STATE_T handleHeaterStateRampUpToTarget( DG_HEATERS_T heater ); static HEATERS_STATE_T handleHeaterStateControlToTarget( DG_HEATERS_T heater ); static void setHeaterDutyCycle( DG_HEATERS_T heater, F32 pwm ); static F32 calculateHeaterDutyCycle( F32 targetTemperature, F32 currentTemperature ); static void setMainPrimaryHeaterPWM( F32 pwm ); static void setSmallPrimaryHeaterPWM( F32 pwm ); static void setTrimmerHeaterPWM( F32 pwm ); static U32 getPublishHeatersDataInterval( void ); static void publishHeatersData( void ); static void checkPrimaryHeaterTempSensors( void ); static void checkTrimmerHeaterTempSensors( void ); static void monitorHeatersVoltage( void ); /**************************************************** New defines ***********************/ /// Primary heaters exec states TODO remove typedef enum primary_heaters_exec_states { PRIMARY_HEATERS_EXEC_STATE_OFF = 0, ///< Primary heaters exec state off PRIMARY_HEATERS_EXEC_STATE_CONTROL_TO_TARGET, ///< Primary heaters exec state control to target (PI controller state) NUM_OF_PRIMARY_HEATERS_EXEC_STATES ///< Number of primary heaters exec states } PRIMARY_HEATERS_EXEC_STATES_T; /// Trimmer heater exec states TODO remove typedef enum trimmer_heater_exec_states { TRIMMER_HEATER_EXEC_STATE_OFF = 0, ///< Trimmer heater exec state off TRIMMER_HEATER_EXEC_STATE_CONTROL_TO_TARGET, ///< Trimmer heater exec state control to target (PI controller state) NUM_OF_TRIMMER_HEATER_EXEC_STATES ///< Number of trimmer heater exec states } TRIMMER_HEATER_EXEC_STATES_T; /// Name of the heaters states TODO remove typedef enum name_of_heaters { PRIMARY_HEATER = 0, ///< Primary heater TRIMMER_HEATER, ///< Trimmer heater NUM_OF_HEATERS ///< Number of heaters } NAME_OF_HEATER_T; // ********** private data ********** static PRIMARY_HEATERS_EXEC_STATES_T primaryHeatersExecState; ///< Primary heaters exec state. TODO remove static TRIMMER_HEATER_EXEC_STATES_T trimmerHeaterExecState; ///< Trimmer heater exec state. TODO remove static F32 primaryHeaterTargetTemperature; ///< Primary heaters target temperature. TODO remove static F32 trimmerHeaterTargetTemperature; ///< Trimmer heater target temperature. TODO remove static F32 mainPrimaryHeaterDutyCycle; ///< Main primary heater duty cycle. TODO remove static F32 smallPrimaryHeaterDutyCycle; ///< Small primary heater duty cycle. TODO remove static F32 trimmerHeaterDutyCycle; ///< Trimmer heater duty cycle. TODO remove static U32 primaryHeaterTimerCounter; ///< Primary heater timer counter. TODO remove static U32 trimmerHeaterTimerCounter; ///< Trimmer heater timer counter. TODO remove static BOOL isPrimaryHeaterOn; ///< Flag to show if the primary heater is on. TODO remove static BOOL isTrimmerHeaterOn; ///< Flag to show if the trimmer heater is on. TODO remove static BOOL hasStartPrimaryHeaterRequested; ///< Start primary heater request flag. TODO remove static BOOL hasStartTrimmerHeaterRequested; ///< Start trimmer heater request flag. TODO remove static TEMPERATURE_SENSORS_T primaryHeatersFeedbackTempSensor = TEMPSENSORS_OUTLET_PRIMARY_HEATER; ///< Primary heaters feedback temperature sensors. TODO remove static TEMPERATURE_SENSORS_T trimmerHeaterFeedbackTempSensor = TEMPSENSORS_INLET_DIALYSATE; ///< Trimmer heater feedback temperature sensors. TODO remove static U32 primaryHeaterTempOutTimer = 0; ///< Primary heaters temperature out of range start timer. TODO remove static U32 trimmerHeaterTempOutTimer = 0; ///< Trimmer heater internal temperature out of range timer. TODO remove static BOOL isPrimaryHeaterTempOutOfRange = FALSE; ///< Boolean flag to indicate if the primary heaters internal temperature out of range. TODO remove static BOOL isTrimmerHeaterTempOutOfRange = FALSE; ///< Boolean flag to indicate if the trimmer heater internal temperature out of range. TODO remove // ********** private function prototypes ********** static PRIMARY_HEATERS_EXEC_STATES_T handlePrimaryHeaterStateOff( void ); // TODO remove static PRIMARY_HEATERS_EXEC_STATES_T handlePrimaryHeaterStateControlToTarget( void ); // TODO remove static TRIMMER_HEATER_EXEC_STATES_T handleTrimmerHeaterStateOff( void ); // TODO remove static TRIMMER_HEATER_EXEC_STATES_T handleTrimmerHeaterControlToTarget( void ); // TODO remove static void resetHeaterState( NAME_OF_HEATER_T heater ); // TODO remove /*********************************************************************//** * @brief * The initHeaters initializes the heaters driver. * @details Inputs: none * @details Outputs: isFlowBelowMin, voltageMonitorTimeCounter, heaterStatus * @return none *************************************************************************/ void initHeaters( void ) { DG_HEATERS_T heater; isFlowBelowMin = FALSE; voltageMonitorTimeCounter = 0; for ( heater = DG_PRIMARY_HEATER; heater < NUM_OF_DG_HEATERS; heater++ ) { heaterStatus[ heater ].controlTimerCounter = 0; // The default feedback sensor of the primary heater is TPo but it changes to THd in heat disinfect // The default feedback sensor of the trimmer heater is TDi all the time heaterStatus[ heater ].feedbackSensor = ( DG_PRIMARY_HEATER == heater ? TEMPSENSORS_OUTLET_PRIMARY_HEATER : TEMPSENSORS_OUTLET_REDUNDANT ); heaterStatus[ heater ].startHeaterSignal = FALSE; heaterStatus[ heater ].tempOutOfRangeTimer = 0; heaterStatus[ heater ].isHeaterTempOutOfRange = FALSE; heaterStatus[ heater ].previousTemperature = 0.0; heaterStatus[ heater ].state = HEATER_EXEC_STATE_NOT_RUNNING; heaterStatus[ heater ].targetTemperature = 0.0; heaterStatus[ heater ].dutycycle = 0.0; heaterStatus[ heater ].maxAllowedDutyCycle = ( DG_PRIMARY_HEATER == heater ? PRIMARY_HEATERS_CUMULATIVE_DUTY_CYCLE : TRIMMER_HEATER_MAX_DUTY_CYCLE ); heaterStatus[ heater ].targetROFlow = 0.0; } // TODO remove // Initialize the PI controller for the primary heaters initializePIController( PI_CONTROLLER_ID_PRIMARY_HEATER, HEATERS_MIN_DUTY_CYCLE, PRIMARY_HEATERS_P_COEFFICIENT, PRIMARY_HEATERS_I_COEFFICIENT, HEATERS_MIN_DUTY_CYCLE, PRIMARY_HEATERS_CUMULATIVE_DUTY_CYCLE ); // Initialize the PI controller for the trimmer heater initializePIController( PI_CONTROLLER_ID_TRIMMER_HEATER, HEATERS_MIN_DUTY_CYCLE, TRIMMER_HEATER_P_COEFFICIENT, TRIMMER_HEATER_I_COEFFICIENT, HEATERS_MIN_DUTY_CYCLE, TRIMMER_HEATER_MAX_DUTY_CYCLE ); // TODO remove } /*********************************************************************//** * @brief * The setHeaterTargetTemperature function sets the target temperature of a heater. * @details Inputs: none * @details Outputs: heaterStatus * @param heater: heater ID that its target temperature is set * @param targetTemperature: target temperature of that the heater has to * heat the fluid * @return none *************************************************************************/ void setHeaterTargetTemperature( DG_HEATERS_T heater, F32 targetTemperature ) { if( heater < NUM_OF_DG_HEATERS ) { if ( ( targetTemperature >= MINIMUM_TARGET_TEMPERATURE ) && ( targetTemperature <= MAXIMUM_TARGET_TEMPERATURE ) ) { heaterStatus[ heater ].targetTemperature = targetTemperature; // TODO alarm if temperature if out of range or just reject? } } else { SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_HEATERS_INVALID_HEATER_ID_SELECTED, heater ) } } /*********************************************************************//** * @brief * The startHeater function starts the specified heater. * @details Inputs: none * @details Outputs: heaterStatus * @param heater: heater ID that is requested to turn on * @return TRUE if the start was accepted otherwise, FALSE *************************************************************************/ BOOL startHeater( DG_HEATERS_T heater ) { BOOL status = FALSE; if( heater < NUM_OF_DG_HEATERS ) { F32 targetTemp = heaterStatus[ heater ].targetTemperature; if ( ( targetTemp >= MINIMUM_TARGET_TEMPERATURE ) && ( targetTemp <= MAXIMUM_TARGET_TEMPERATURE ) ) { status = TRUE; heaterStatus[ heater ].startHeaterSignal = TRUE; } } else { SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_HEATERS_INVALID_HEATER_ID_SELECTED, heater ) } return status; } /*********************************************************************//** * @brief * The stopHeater stops the specified heater. * @details Inputs: none * @details Outputs: heaterStatus * @param heater: heater ID that is requested to turn on * @return TRUE if the start was accepted otherwise, FALSE *************************************************************************/ void stopHeater( DG_HEATERS_T heater ) { heaterStatus[ heater ].isHeaterOn = FALSE; } /*********************************************************************//** * @brief * The execHeaters function executes the heaters state machine. * @details Inputs: heaterStatus * @details Outputs: heaterStatus * @return none *************************************************************************/ void execHeaters( void ) { DG_HEATERS_T heater; HEATERS_STATE_T state; for ( heater = DG_PRIMARY_HEATER; heater < NUM_OF_DG_HEATERS; heater++ ) { state = heaterStatus[ heater ].state; switch( state ) { case HEATER_EXEC_STATE_NOT_RUNNING: heaterStatus[ heater ].state = handleHeaterStateNotRunning( heater ); break; case HEATER_EXEC_STATE_RAMP_UP_TO_TARGET: heaterStatus[ heater ].state = handleHeaterStateRampUpToTarget( heater ); break; case HEATER_EXEC_STATE_CONTROL_TO_TARGET: heaterStatus[ heater ].state = handleHeaterStateControlToTarget( heater ); break; default: // The heater is in an unknown state. Turn it off and switch to not running state stopHeater( heater ); heaterStatus[ heater ].state = HEATER_EXEC_STATE_NOT_RUNNING; SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_HEATERS_INVALID_EXEC_STATE, heater ); break; } } } /*********************************************************************//** * @brief * The handleTrimmerHeaterCmd handles a start trimmer heater command from the HD. * It resets the trimmer heater's state and sets the duty cycle of the trimmer heater. * @details Inputs: none * @details Outputs: process command and send back response * @param heaterCmdPtr pointer to heater command data record * @return status *************************************************************************/ void handleTrimmerHeaterCmd( TRIMMER_HEATER_CMD_T *heaterCmdPtr ) { DG_CMD_RESPONSE_T cmdResponse; cmdResponse.commandID = DG_CMD_START_TRIMMER_HEATER; cmdResponse.rejected = TRUE; cmdResponse.rejectCode = DG_CMD_REQUEST_REJECT_REASON_NONE; if ( TRUE == heaterCmdPtr->startHeater ) { if ( ( MINIMUM_TARGET_TEMPERATURE <= heaterCmdPtr->targetTemp ) && ( heaterCmdPtr->targetTemp <= MAXIMUM_TARGET_TEMPERATURE ) ) { cmdResponse.rejected = FALSE; #ifndef DISABLE_HEATERS_AND_TEMPS trimmerHeaterTargetTemperature = heaterCmdPtr->targetTemp; hasStartTrimmerHeaterRequested = TRUE; #endif } else { cmdResponse.rejectCode = DG_CMD_REQUEST_REJECT_REASON_INVALID_PARAMETER; } } else { cmdResponse.rejected = FALSE; stopTrimmerHeater(); } sendCommandResponseMsg( &cmdResponse ); } /*********************************************************************//** * @brief * The execHeatersMonitor function monitors the status of the heaters. * The internal temperature sensors and the voltages of the heaters are * monitored. The flow is continuously checked and if there is no flow * for a period of time, the heaters are turned off. * @details Inputs: isTrimmerHeaterOn, mainPrimaryHeaterDutyCycle, * smallPrimaryHeaterDutyCycle, trimmerHeaterDutyCycle, * heatersOnWithNoFlowTimer, isFlowBelowMin * @details Outputs: heatersOnWithNoFlowTimer, isFlowBelowMin * @return none *************************************************************************/ void execHeatersMonitor( void ) { #ifndef IGNORE_HEATERS_MONITOR checkPrimaryHeaterTempSensors(); checkTrimmerHeaterTempSensors(); #endif // Monitor the heaters voltage //monitorHeatersVoltage(); /* * If any of the heaters are on or any of the heaters' PWMs are not zero, check if the flow is below than the minimum value * If the flow is below minimum for the first time, set the variables * If the flow is below minimum for more than the defined time, stop the heaters and raise the alarm * If the flow is in range, reset the variables * This is to make sure that any of the heaters do not stay on while there is no flow * In the monitor, trimmer heater is only monitored if heat disinfect mode is active. Trimmer heater is usually * controlled by HD so checking the DG flow rate to decide whether it should be on or off is not appropriate */ BOOL isModeHeat = ( DG_MODE_HEAT == getCurrentOperationMode() ) && ( TRUE == isTrimmerHeaterOn ); BOOL isHeaterOn = ( TRUE == isPrimaryHeaterOn ) || ( TRUE == isModeHeat ); BOOL isPWMNonZero = ( mainPrimaryHeaterDutyCycle > HEATERS_MIN_DUTY_CYCLE ) || ( smallPrimaryHeaterDutyCycle > HEATERS_MIN_DUTY_CYCLE ) || ( trimmerHeaterDutyCycle > HEATERS_MIN_DUTY_CYCLE ); if ( ( TRUE == isHeaterOn ) || ( TRUE == isPWMNonZero ) ) { F32 measuredFlow = getMeasuredROFlowRate(); if ( measuredFlow < MIN_RO_FLOWRATE_LPM ) { // Flow is below minimum for the first time if ( FALSE == isFlowBelowMin ) { isFlowBelowMin = TRUE; heatersOnWithNoFlowTimer = getMSTimerCount(); } // Flow is below minimum for a long time so raise the alarm else if ( TRUE == didTimeout( heatersOnWithNoFlowTimer, HEATERS_ON_NO_FLOW_TIMEOUT_MS ) ) { stopPrimaryHeater(); stopTrimmerHeater(); activateAlarmNoData( ALARM_ID_DG_HEATERS_ON_WITH_NO_FLOW_TIMEOUT ); } } else { isFlowBelowMin = FALSE; heatersOnWithNoFlowTimer = getMSTimerCount(); } } // Check for data publication publishHeatersData(); } /*********************************************************************//** * @brief * The handleHeaterStateNotRunning function handles the heater not running state. * @details Inputs: heaterStatus * @details Outputs: heaterStatus * @param heater: The heater Id that its not running state is handled * @return next state of the state machine *************************************************************************/ static HEATERS_STATE_T handleHeaterStateNotRunning( DG_HEATERS_T heater ) { HEATERS_STATE_T state = HEATER_EXEC_STATE_NOT_RUNNING; if ( TRUE == heaterStatus[ heater ].startHeaterSignal ) { heaterStatus[ heater ].isHeaterOn = TRUE; heaterStatus[ heater ].startHeaterSignal = FALSE; // If the operation mode is heater disinfect and the heater is primary heater, change the feedback sensor to THd if ( ( DG_MODE_HEAT == getCurrentOperationMode() ) && ( DG_PRIMARY_HEATER == heater ) ) { #ifdef THD_USING_TRO_CONNECTOR // Set the feedback temperature sensor and THd uses TRo in V3 heaterStatus[ heater ].feedbackSensor = TEMPSENSORS_OUTLET_REDUNDANT; #else heaterStatus[ heater ].feedbackSensor = TEMPSENSORS_HEAT_DISINFECT; #endif } // Set the heater duty cycle to maximum setHeaterDutyCycle( heater, heaterStatus[ heater ].maxAllowedDutyCycle ); // Turn on the heater state = HEATER_EXEC_STATE_RAMP_UP_TO_TARGET; } return state; } /*********************************************************************//** * @brief * The handleHeaterStateRampUpToTarget function handles the heaters' control * while they are ramped up to target temperature. * @details Inputs: heaterStatus * @details Outputs: heaterStatus * @param heater: The heater Id that its on state is handled * @return next state of the state machine *************************************************************************/ static HEATERS_STATE_T handleHeaterStateRampUpToTarget( DG_HEATERS_T heater ) { HEATERS_STATE_T state = HEATER_EXEC_STATE_RAMP_UP_TO_TARGET; TEMPERATURE_SENSORS_T sensor = heaterStatus[ heater ].feedbackSensor; F32 temperature = getTemperatureValue( (U32)sensor ); // TODO remove setHeaterDutyCycle( heater, 0.44 ); if ( FALSE == heaterStatus[ heater ].isHeaterOn ) { setHeaterDutyCycle( heater, HEATERS_MIN_DUTY_CYCLE ); state = HEATER_EXEC_STATE_NOT_RUNNING; } // TODO remove /*if ( ++heaterStatus[ heater ].controlTimerCounter > CONTROLLER_CHECK_INTERVAL_COUNT ) { // If the heaters are not longer on, set the duty cycle to 0 if ( FALSE == heaterStatus[ heater ].isHeaterOn ) { setHeaterDutyCycle( heater, HEATERS_MIN_DUTY_CYCLE ); } else { F32 targetTemperature = heaterStatus[ heater ].targetTemperature; F32 prevTemperature = heaterStatus[ heater ].previousTemperature; F32 temperatureSlope = ( temperature - prevTemperature ) / CONTROLLER_CHECK_INTERVAL_COUNT; if ( temperatureSlope > 0.0 ) { // TODO make a #define for delta temperature from target // TODO create the cases for the temperature being above the target if ( ( targetTemperature - temperature > 0.5 ) && ( temperature < targetTemperature ) ) { setHeaterDutyCycle( heater, heaterStatus[ heater ].maxAllowedDutyCycle ); } if ( ( targetTemperature - temperature < 0.5 ) && ( temperature < targetTemperature ) ) { // We are in range // Start the P controller } } else if ( ( temperatureSlope < 0.0 ) && ( targetTemperature - temperature < 0.5 ) && ( temperature < targetTemperature ) ) { setHeaterDutyCycle( heater, heaterStatus[ heater ].maxAllowedDutyCycle ); } } heaterStatus[ heater ].controlTimerCounter = 0; }*/ return state; } static HEATERS_STATE_T handleHeaterStateControlToTarget( DG_HEATERS_T heater ) { HEATERS_STATE_T state = HEATER_EXEC_STATE_CONTROL_TO_TARGET; F32 flow = getMeasuredROFlowRate(); F32 power = sqrt( ( targetTemperature - currentTemperature ) * flow ); F32 dutyCycle = ( ( power * PRIMARY_HEATERS_POWER_TO_VOLTAGE_SLOPE ) - PRIMARY_HEATERS_POWER_TO_VOLTAGE_INTERCEPT ) / HEATERS_MAX_OPERATING_VOLTAGE_V; return state; } /*********************************************************************//** * @brief * The setHeaterDutyCycle function sets the duty cycle of a heater. * @details Inputs: none * @details Outputs: none * @param heater: The heater Id that its duty cycle is set * @param pwm: The PWM that is set * @return none *************************************************************************/ static void setHeaterDutyCycle( DG_HEATERS_T heater, F32 pwm ) { if ( DG_PRIMARY_HEATER == heater ) { F32 main = pwm / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; F32 small = pwm / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; setMainPrimaryHeaterPWM( main ); setSmallPrimaryHeaterPWM( small ); heaterStatus[ DG_PRIMARY_HEATER ].dutycycle = main; } else if ( DG_TRIMMER_HEATER == heater ) { setTrimmerHeaterPWM( pwm ); heaterStatus[ DG_TRIMMER_HEATER ].dutycycle = pwm; } } static F32 calculateHeaterDutyCycle( F32 targetTemperature, F32 currentTemperature ) { F32 flow = getMeasuredROFlowRate(); F32 power = sqrt( ( targetTemperature - currentTemperature ) * flow ); F32 dutyCycle = ( ( power * PRIMARY_HEATERS_POWER_TO_VOLTAGE_SLOPE ) - PRIMARY_HEATERS_POWER_TO_VOLTAGE_INTERCEPT ) / HEATERS_MAX_OPERATING_VOLTAGE_V; return dutyCycle; } /*********************************************************************//** * @brief * The setPrimaryHeaterTargetTemperature function sets the primary heater * target temperature. * @details Inputs: none * @details Outputs: primaryHeaterTargetTemperature * @param targetTemp target temperature for the primary heater * @return none *************************************************************************/ void setPrimaryHeaterTargetTemperature( F32 targetTemp ) { primaryHeaterTargetTemperature = targetTemp; } /*********************************************************************//** * @brief * The setTrimmerHeaterTargetTemperature function sets the trimmer heater * target temperature. * @details Inputs: none * @details Outputs: trimmerHeaterTargetTemperature * @param targetTemp target temperature for the trimmer heater * @return none *************************************************************************/ void setTrimmerHeaterTargetTemperature( F32 targetTemp ) { trimmerHeaterTargetTemperature = targetTemp; } /*********************************************************************//** * @brief * The startPrimaryHeater function starts the primary heaters. It resets * the primary heaters state and sets the main primary heater duty cycle. * @details Inputs: primaryHeaterTargetTemperature * @details Outputs: hasStartPrimaryHeaterRequested * @return status *************************************************************************/ BOOL startPrimaryHeater( void ) { BOOL status = FALSE; if ( ( primaryHeaterTargetTemperature >= MINIMUM_TARGET_TEMPERATURE ) && ( primaryHeaterTargetTemperature <= MAXIMUM_TARGET_TEMPERATURE ) ) { hasStartPrimaryHeaterRequested = TRUE; status = TRUE; } return status; } /*********************************************************************//** * @brief * The startTrimmerHeater function starts the trimmer heater. It resets the * trimmer heater's state and sets the duty cycle of the trimmer heater. * @details Inputs: trimmerHeaterTargetTemperature * @details Outputs: hasStartTrimmerHeaterRequested * @return status *************************************************************************/ BOOL startTrimmerHeater( void ) { BOOL status = FALSE; if ( ( trimmerHeaterTargetTemperature >= MINIMUM_TARGET_TEMPERATURE ) && ( trimmerHeaterTargetTemperature <= MAXIMUM_TARGET_TEMPERATURE ) ) { hasStartTrimmerHeaterRequested = TRUE; status = TRUE; } return status; } /*********************************************************************//** * @brief * The stopPrimaryHeater function stops the primary heater. * @details Inputs: none * @details Outputs: Primary heater stops * @return none *************************************************************************/ void stopPrimaryHeater( void ) { setMainPrimaryHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); setSmallPrimaryHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); isPrimaryHeaterOn = FALSE; } /*********************************************************************//** * @brief * The stopTrimmerHeater function stops the trimmer heater. * @details Inputs: none * @details Outputs: Trimmer heater stops * @return none *************************************************************************/ void stopTrimmerHeater( void ) { setTrimmerHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); isTrimmerHeaterOn = FALSE; } /*********************************************************************//** * @brief * The execPrimaryHeaters function executes the primary heaters' state machine. * @details Inputs: primaryHeatersExecState * @details Outputs: primaryHeatersExecState * @return none *************************************************************************/ void execPrimaryHeaters( void ) { switch ( primaryHeatersExecState ) { case PRIMARY_HEATERS_EXEC_STATE_OFF: primaryHeatersExecState = handlePrimaryHeaterStateOff(); break; case PRIMARY_HEATERS_EXEC_STATE_CONTROL_TO_TARGET: primaryHeatersExecState = handlePrimaryHeaterStateControlToTarget(); break; default: SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_HEATERS_INVALID_EXEC_STATE, primaryHeatersExecState ); primaryHeatersExecState = PRIMARY_HEATERS_EXEC_STATE_CONTROL_TO_TARGET; break; } } /*********************************************************************//** * @brief * The execTrimmerHeater function executes the trimmer heater's state machine. * @details Inputs: trimmerHeaterExecState * @details Outputs: trimmerHeaterExecState * @return none *************************************************************************/ void execTrimmerHeater( void ) { switch ( trimmerHeaterExecState ) { case TRIMMER_HEATER_EXEC_STATE_OFF: trimmerHeaterExecState = handleTrimmerHeaterStateOff(); break; case TRIMMER_HEATER_EXEC_STATE_CONTROL_TO_TARGET: trimmerHeaterExecState = handleTrimmerHeaterControlToTarget(); break; default: SET_ALARM_WITH_2_U32_DATA( ALARM_ID_DG_SOFTWARE_FAULT, SW_FAULT_ID_HEATERS_INVALID_EXEC_STATE, trimmerHeaterExecState ); trimmerHeaterExecState = TRIMMER_HEATER_EXEC_STATE_CONTROL_TO_TARGET; break; } } /*********************************************************************//** * @brief * The handlePrimaryHeaterStateOff function handles the primary heaters at * off state. * @details Inputs: hasStartPrimaryHeaterRequested, isPrimaryHeaterOn * @details Outputs: state (PRIMARY_HEATERS_EXEC_STATES_T), isPrimaryHeaterOn * @return state (PRIMARY_HEATERS_EXEC_STATES_T) *************************************************************************/ static PRIMARY_HEATERS_EXEC_STATES_T handlePrimaryHeaterStateOff( void ) { PRIMARY_HEATERS_EXEC_STATES_T state = PRIMARY_HEATERS_EXEC_STATE_OFF; if ( TRUE == hasStartPrimaryHeaterRequested ) { resetHeaterState( PRIMARY_HEATER ); // Once the primary heaters duty cycle is set, it is divided into 2 // so both heaters will start and both elements are heated up setMainPrimaryHeaterPWM( mainPrimaryHeaterDutyCycle ); setSmallPrimaryHeaterPWM( smallPrimaryHeaterDutyCycle ); isPrimaryHeaterOn = TRUE; hasStartPrimaryHeaterRequested = FALSE; // Check if the operation mode is heat disinfect. If the mode is // heat disinfect, the feedback sensor will be Thd if ( DG_MODE_HEAT == getCurrentOperationMode() ) { #ifdef THD_USING_TRO_CONNECTOR // Set the feedback temperature sensor // THd uses TRo in V3 primaryHeatersFeedbackTempSensor = TEMPSENSORS_OUTLET_REDUNDANT; #else primaryHeatersFeedbackTempSensor = TEMPSENSORS_HEAT_DISINFECT; #endif } state = PRIMARY_HEATERS_EXEC_STATE_CONTROL_TO_TARGET; } return state; } /*********************************************************************//** * @brief * The handlePrimaryHeaterStateControlToTarget function handles the primary * heaters at control state when the heaters are active. * @details Inputs: primaryHeaterTimerCounter, mainPrimaryHeaterDutyCycle, * smallPrimaryHeaterDutyCycle, isPrimaryHeaterOn * @details Outputs: primaryHeaterTimerCounter, mainPrimaryHeaterDutyCycle, * smallPrimaryHeaterDutyCycle * @return state (PRIMARY_HEATERS_EXEC_STATES_T) *************************************************************************/ static PRIMARY_HEATERS_EXEC_STATES_T handlePrimaryHeaterStateControlToTarget( void ) { PRIMARY_HEATERS_EXEC_STATES_T state = PRIMARY_HEATERS_EXEC_STATE_CONTROL_TO_TARGET; if ( ++primaryHeaterTimerCounter >= CONTROLLER_CHECK_INTERVAL_COUNT ) { // Check if the flow is not below minimum required first // If the flow is below minimum, send 0.00 to the PWM until the flow comes back to range // If the flow is within range, run the PI controller to control the heaters normally if ( FALSE == isFlowBelowMin ) { // If the primary heater is running and another start primary heater request // is set, reset the primary heater again if ( TRUE == hasStartPrimaryHeaterRequested ) { resetHeaterState( PRIMARY_HEATER ); hasStartPrimaryHeaterRequested = FALSE; } else { F32 outletTemp = getTemperatureValue( primaryHeatersFeedbackTempSensor ); mainPrimaryHeaterDutyCycle = runPIController( PI_CONTROLLER_ID_PRIMARY_HEATER, primaryHeaterTargetTemperature, outletTemp ); // Once the primary heaters duty cycle is set, it is divided into 2 so both heaters will start and both elements are heated up smallPrimaryHeaterDutyCycle = mainPrimaryHeaterDutyCycle / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; mainPrimaryHeaterDutyCycle = mainPrimaryHeaterDutyCycle / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; } setMainPrimaryHeaterPWM( mainPrimaryHeaterDutyCycle ); setSmallPrimaryHeaterPWM( smallPrimaryHeaterDutyCycle ); } // Flow is below the minimum required flow to run the primary heaters else { setMainPrimaryHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); setSmallPrimaryHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); } primaryHeaterTimerCounter = 0; } if ( FALSE == isPrimaryHeaterOn ) { // Switch to off state. Set the duty cycles to 0 mainPrimaryHeaterDutyCycle = HEATERS_MIN_DUTY_CYCLE; smallPrimaryHeaterDutyCycle = HEATERS_MIN_DUTY_CYCLE; state = PRIMARY_HEATERS_EXEC_STATE_OFF; } return state; } /*********************************************************************//** * @brief * The handleTrimmerHeaterStateOff function handles the trimmer heater at * off state. * @details Inputs: hasStartTrimmerHeaterRequested, isTrimmerHeaterOn * @details Outputs: state (TRIMMER_HEATER_EXEC_STATES_T), isTrimmerHeaterOn * @return state (TRIMMER_HEATER_EXEC_STATES_T) *************************************************************************/ static TRIMMER_HEATER_EXEC_STATES_T handleTrimmerHeaterStateOff( void ) { TRIMMER_HEATER_EXEC_STATES_T state = TRIMMER_HEATER_EXEC_STATE_OFF; if ( TRUE == hasStartTrimmerHeaterRequested ) { resetHeaterState( TRIMMER_HEATER ); isTrimmerHeaterOn = TRUE; hasStartTrimmerHeaterRequested = FALSE; setTrimmerHeaterPWM( trimmerHeaterDutyCycle ); state = TRIMMER_HEATER_EXEC_STATE_CONTROL_TO_TARGET; } return state; } /*********************************************************************//** * @brief * The handleTrimmerHeaterControlToTarget function handles the trimmer * heater at control state when the heater is active. * @details Inputs: trimmerHeaterTimerCounter, trimmerHeaterDutyCycle * @details Outputs: trimmerHeaterTimerCounter, trimmerHeaterDutyCycle, * isTrimmerHeaterOn * @return state (TRIMMER_HEATER_EXEC_STATES_T) *************************************************************************/ static TRIMMER_HEATER_EXEC_STATES_T handleTrimmerHeaterControlToTarget( void ) { TRIMMER_HEATER_EXEC_STATES_T state = TRIMMER_HEATER_EXEC_STATE_CONTROL_TO_TARGET; if ( ++trimmerHeaterTimerCounter >= CONTROLLER_CHECK_INTERVAL_COUNT ) { // Check if the flow is not below minimum required first // If the flow is below minimum, send 0.00 to the PWM until the flow comes back to range // If the flow is within range, run the PI controller to control the heaters normally if ( FALSE == isFlowBelowMin ) { F32 outletTemp = getTemperatureValue( trimmerHeaterFeedbackTempSensor ); trimmerHeaterDutyCycle = runPIController( PI_CONTROLLER_ID_TRIMMER_HEATER, trimmerHeaterTargetTemperature, outletTemp ); setTrimmerHeaterPWM( trimmerHeaterDutyCycle ); } else { setTrimmerHeaterPWM( HEATERS_MIN_DUTY_CYCLE ); } trimmerHeaterTimerCounter = 0; } if ( FALSE == isTrimmerHeaterOn ) { // Set the duty cycle to 0 and switch to off state trimmerHeaterDutyCycle = HEATERS_MIN_DUTY_CYCLE; state = TRIMMER_HEATER_EXEC_STATE_OFF; } return state; } /*********************************************************************//** * @brief * The setMainPrimaryHeaterPWM function sets the PWM of the main primary heater. * @details Inputs: none * @details Outputs: Sets the PWM duty cycle for the main primary heater * @param pwm PWM duty cycle to set for 1st primary heater element * @return none *************************************************************************/ static void setMainPrimaryHeaterPWM( F32 pwm ) { etpwmSetCmpA( etpwmREG1, (U32)( (S32)( ( pwm * (F32)(etpwmREG1->TBPRD) ) + FLOAT_TO_INT_ROUNDUP_OFFSET ) ) ); } /*********************************************************************//** * @brief * The setSmallPrimaryHeaterPWM function sets the PWM of the small primary heater. * @details Inputs: none * @details Outputs: Sets the PWM duty cycle for the small primary heater * @param pwm PWM duty cycle to set for 2nd primary heater element * @return none *************************************************************************/ static void setSmallPrimaryHeaterPWM( F32 pwm ) { etpwmSetCmpB( etpwmREG1, (U32)( (S32)( ( pwm * (F32)(etpwmREG1->TBPRD) ) + FLOAT_TO_INT_ROUNDUP_OFFSET ) ) ); } /*********************************************************************//** * @brief * The setTrimmerHeaterPWM function sets the PWM of the trimmer heater. * @details Inputs: none * @details Outputs: Sets the PWM duty cycle for the trimmer heater * @param pwm PWM duty cycle to set for trimmer heater * @return none *************************************************************************/ static void setTrimmerHeaterPWM( F32 pwm ) { etpwmSetCmpA( etpwmREG3, (U32)( (S32)( ( pwm * (F32)(etpwmREG3->TBPRD) ) + FLOAT_TO_INT_ROUNDUP_OFFSET ) ) ); } /*********************************************************************//** * @brief * The resetHeaterState function resets the PI controller of the selected heater. * @details Inputs: mainPrimaryHeaterDutyCycle, trimmerHeaterDutyCycle * @details Outputs: mainPrimaryHeaterDutyCycle, trimmerHeaterDutyCycle * @param heater enumeration of the heater for which the PI controller will be reset * @return none *************************************************************************/ static void resetHeaterState( NAME_OF_HEATER_T heater ) { if ( PRIMARY_HEATER == heater ) { // Calculate the delta temperature from the inlet primary heater to target temperature F32 inletPrimaryHeaterTemp = getTemperatureValue( TEMPSENSORS_INLET_PRIMARY_HEATER ); F32 deltaTemp = primaryHeaterTargetTemperature - inletPrimaryHeaterTemp; // If the delta temperature (target temperature - inlet primary heater temperature) // Is 0 or negative, the duty cycle is 0.0 if ( deltaTemp <= 0.0 ) { mainPrimaryHeaterDutyCycle = HEATERS_MIN_DUTY_CYCLE; smallPrimaryHeaterDutyCycle = HEATERS_MIN_DUTY_CYCLE; } else { // The formula for the initial guess is: (delta temperature * target flow) / 2.0 F32 targetFlow = getTargetROPumpFlowRate(); F32 duty = ( targetFlow * deltaTemp ) / PRIMARY_HEATER_INITIAL_DUTY_CYCLE_ESTIMATE_DIVISOR; // If the duty cycle is greater 200% on the primary and small primary heaters, set it to 200%, otherwise set it to the // estimated duty cycles duty = ( duty > PRIMARY_HEATERS_CUMULATIVE_DUTY_CYCLE ? PRIMARY_HEATERS_CUMULATIVE_DUTY_CYCLE : duty ); mainPrimaryHeaterDutyCycle = duty / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; smallPrimaryHeaterDutyCycle = duty / MAIN_AND_SMALL_PRIMARY_HEATER_DUTY_CYCLE_DIVISOR; } // The PI controller of the primary heater consists of main and small primary heaters duty cycles resetPIController( PI_CONTROLLER_ID_PRIMARY_HEATER, mainPrimaryHeaterDutyCycle + smallPrimaryHeaterDutyCycle ); } else if ( TRIMMER_HEATER == heater ) { trimmerHeaterDutyCycle = TRIMMER_HEATER_MAX_DUTY_CYCLE; resetPIController( PI_CONTROLLER_ID_TRIMMER_HEATER, TRIMMER_HEATER_MAX_DUTY_CYCLE ); } } /*********************************************************************//** * @brief * The getPublishHeatersDataInterval function gets the publish interval. * @details Inputs: heatersDataPublishInterval * @details Outputs: none * @return result *************************************************************************/ U32 getPublishHeatersDataInterval( void ) { U32 result = heatersDataPublishInterval.data; if ( OVERRIDE_KEY == heatersDataPublishInterval.override ) { result = heatersDataPublishInterval.ovData; } return result; } /*********************************************************************//** * @brief * The publishTemperatureData function publishes the heaters data into * at the defined time interval. * @details Inputs: dataPublicationTimerCounter * @details Outputs: dataPublicationTimerCounter * @return none *************************************************************************/ static void publishHeatersData( void ) { if ( ++dataPublicationTimerCounter >= getPublishHeatersDataInterval() ) { HEATERS_DATA_T data; data.mainPrimayHeaterDC = heaterStatus[ DG_PRIMARY_HEATER ].dutycycle * 100.0; // The duty cycle of the primary heater is divided into 2 parts and is applied to main // and small primary heaters. So they are always the same. data.smallPrimaryHeaterDC = heaterStatus[ DG_PRIMARY_HEATER ].dutycycle * 100.0; data.trimmerHeaterDC = heaterStatus[ DG_TRIMMER_HEATER ].dutycycle * 100.0; data.primaryTargetTemp = heaterStatus[ DG_PRIMARY_HEATER ].targetTemperature; data.trimmerTargetTemp = heaterStatus[ DG_TRIMMER_HEATER ].targetTemperature; broadcastHeatersData( &data ); dataPublicationTimerCounter = 0; } } /*********************************************************************//** * @brief * The checkPrimaryHeaterTempSensors function checks the primary heater's * thermocouple and cold junction temperature sensors. * @details Inputs: isPrimaryHeaterTempOutOfRange * @details Outputs: isPrimaryHeaterTempOutOfRange * @return none *************************************************************************/ static void checkPrimaryHeaterTempSensors( void ) { F32 primaryHeaterInternalTemp = getTemperatureValue( TEMPSENSORS_PRIMARY_HEATER_INTERNAL ); F32 primaryHeaterColdJunctionTemp = getTemperatureValue( TEMPSENSORS_PRIMARY_HEATER_COLD_JUNCTION ); BOOL isTempOut = FALSE; // Check if the primary heater's internal temperature or the cold junction temperature is above the allowed limit if ( primaryHeaterInternalTemp > HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_C ) { isTempOut = TRUE; SET_ALARM_WITH_1_U32_DATA( ALARM_ID_DG_PRIMARY_HEATER_INTERNAL_TEMP_OUT_OF_RANGE, primaryHeaterInternalTemp ); } else if ( primaryHeaterColdJunctionTemp > HEATERS_MAX_ALLOWED_COLD_JUNCTION_TEMPERATURE_C ) { isTempOut = TRUE; SET_ALARM_WITH_1_U32_DATA( ALARM_ID_DG_PRIMARY_HEATER_CJ_TEMP_OUT_OF_RANGE, primaryHeaterInternalTemp ); } // If any of the temperatures are above the range if ( ( FALSE == isPrimaryHeaterTempOutOfRange ) && ( TRUE == isTempOut ) ) { stopPrimaryHeater(); isPrimaryHeaterTempOutOfRange = TRUE; primaryHeaterTempOutTimer = getMSTimerCount(); } // If the primary heaters internal temperature was out for more than the define period, activate the safety shutdown else if ( ( TRUE == isPrimaryHeaterTempOutOfRange ) && ( TRUE == didTimeout( primaryHeaterTempOutTimer, HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_TIMEOUT_MS ) ) ) { isPrimaryHeaterTempOutOfRange = FALSE; activateSafetyShutdown(); } } /*********************************************************************//** * @brief * The checkTrimmerHeaterTempSensors function checks the trimmer heater's * thermocouple and cold junction temperature sensors. * @details Inputs: isTrimmerHeaterTempOutOfRange * @details Outputs: isTrimmerHeaterTempOutOfRange * @return none *************************************************************************/ static void checkTrimmerHeaterTempSensors( void ) { F32 trimmerHeaterInternalTemp = getTemperatureValue( TEMPSENSORS_TRIMMER_HEATER_INTERNAL ); F32 trimmerHeaterColdJunctionTemp = getTemperatureValue( TEMPSENSORS_TRIMMER_HEATER_COLD_JUNCTION ); BOOL isTempOut = FALSE; // Check if the primary heater's internal temperature or the cold junction temperature is above the allowed limit if ( trimmerHeaterInternalTemp > HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_C ) { isTempOut = TRUE; SET_ALARM_WITH_1_U32_DATA( ALARM_ID_DG_TRIMMER_HEATER_INTERNAL_TEMP_OUT_OF_RANGE, trimmerHeaterInternalTemp ); } else if ( trimmerHeaterColdJunctionTemp > HEATERS_MAX_ALLOWED_COLD_JUNCTION_TEMPERATURE_C ) { isTempOut = TRUE; SET_ALARM_WITH_1_U32_DATA( ALARM_ID_DG_TRIMMER_HEATER_CJ_TEMP_OUT_OF_RANGE, trimmerHeaterColdJunctionTemp ); } // If it is above the range for the first time, stop the trimmer heater // and set the variables if ( ( FALSE == isTrimmerHeaterTempOutOfRange ) && ( TRUE == isTempOut ) ) { stopTrimmerHeater(); isTrimmerHeaterTempOutOfRange = TRUE; trimmerHeaterTempOutTimer = getMSTimerCount(); } // If the trimmer heater internal temperature was out for more than the define period, activate the safety shutdown else if ( ( TRUE == isTrimmerHeaterTempOutOfRange ) && ( TRUE == didTimeout( trimmerHeaterTempOutTimer, HEATERS_MAX_ALLOWED_INTERNAL_TEMPERATURE_TIMEOUT_MS ) ) ) { activateSafetyShutdown(); } } /*********************************************************************//** * @brief * The monitorHeatersVoltage function monitors the heaters' voltages * @details Inputs: heatersVoltageMonitorTimeCounter * @details Outputs: heatersVoltageMonitorTimeCounter * @return none *************************************************************************/ static void monitorHeatersVoltage( void ) { if ( ++voltageMonitorTimeCounter >= HEATERS_VOLTAGE_MONITOR_TIME_INTERVAL ) { F32 mainPriVoltage = getIntADCVoltageConverted( INT_ADC_PRIMARY_HEATER_24_VOLTS ); // TODO it is assumed that the main and small primary heaters have equal voltage since the PWMs are divided into 2 // before applying the PWMs to the heaters. Right now, there is no ADC channel available for the small primary // heater so the main primary heater's ADC channel is used for the small primary heater as well. F32 smallPriVoltage = getIntADCVoltageConverted( INT_ADC_PRIMARY_HEATER_24_VOLTS ); F32 trimmerVoltage = getIntADCVoltageConverted( INT_ADC_TRIMMER_HEATER_24_VOLTS ); // Voltage to PWM is reverse. If PWM = 0 -> V = 24V F32 mainPri = 1.0 - mainPrimaryHeaterDutyCycle; F32 smallPri = 1.0 - smallPrimaryHeaterDutyCycle; F32 trimmer = 1.0 - trimmerHeaterDutyCycle; // Check main primary heater's voltage // The corresponding voltage of the current PWM must be close to the sensed voltage if ( fabs( ( HEATERS_MAX_OPERATING_VOLTAGE_V * mainPri ) - mainPriVoltage ) > HEATERS_MAX_VOLTAGE_OUT_OF_RANGE_TOL * mainPriVoltage ) { SET_ALARM_WITH_1_F32_DATA( ALARM_ID_DG_MAIN_PRIMARY_HEATER_VOLTAGE_OUT_OF_RANGE, mainPriVoltage ); } // Check small primary heater's voltage if ( fabs( ( HEATERS_MAX_OPERATING_VOLTAGE_V * smallPri ) - smallPriVoltage ) > HEATERS_MAX_VOLTAGE_OUT_OF_RANGE_TOL * smallPriVoltage ) { SET_ALARM_WITH_1_F32_DATA( ALARM_ID_DG_SMALL_PRIMARY_HEATER_VOLTAGE_OUT_OF_RANGE, smallPriVoltage ); } // Check trimmer heater's voltage if ( fabs( ( HEATERS_MAX_OPERATING_VOLTAGE_V * trimmer ) - trimmerVoltage ) > HEATERS_MAX_VOLTAGE_OUT_OF_RANGE_TOL * trimmerVoltage ) { SET_ALARM_WITH_1_F32_DATA( ALARM_ID_DG_TRIMMER_HEATER_VOLTAGE_OUT_OF_RANGE, trimmerVoltage ); } voltageMonitorTimeCounter = 0; } } /************************************************************************* * TEST SUPPORT FUNCTIONS *************************************************************************/ /*********************************************************************//** * @brief * The testSetHeatersPublishIntervalOverride function overrides the heaters * publish data time interval. * @details Inputs: heatersDataPublishInterval * @details Outputs: heatersDataPublishInterval * @return result *************************************************************************/ BOOL testSetHeatersPublishIntervalOverride( U32 value ) { BOOL result = FALSE; if ( TRUE == isTestingActivated() ) { U32 interval = value / TASK_PRIORITY_INTERVAL; result = TRUE; heatersDataPublishInterval.ovData = interval; heatersDataPublishInterval.override = OVERRIDE_KEY; } return result; } /*********************************************************************//** * @brief * The testResetHeatersPublishIntervalOverride function resets the heaters * publish time interval to its previous time interval. * @details Inputs: heatersDataPublishInterval * @details Outputs: heatersDataPublishInterval * @return result *************************************************************************/ BOOL testResetHeatersPublishIntervalOverride( void ) { BOOL result = FALSE; if ( TRUE == isTestingActivated() ) { result = TRUE; heatersDataPublishInterval.override = OVERRIDE_RESET; heatersDataPublishInterval.ovData = heatersDataPublishInterval.ovInitData; } return result; } /**@}*/