Index: firmware/App/Monitors/Temperature.c =================================================================== diff -u -r313982ccc772f1bbe182877dff7e00381b04e0f4 -r387ea33c2e45705550905bc1a97e13db1cc95bf8 --- firmware/App/Monitors/Temperature.c (.../Temperature.c) (revision 313982ccc772f1bbe182877dff7e00381b04e0f4) +++ firmware/App/Monitors/Temperature.c (.../Temperature.c) (revision 387ea33c2e45705550905bc1a97e13db1cc95bf8) @@ -15,13 +15,16 @@ * ***************************************************************************/ +#include "BalancingChamber.h" #include "ConductivitySensors.h" #include "Messaging.h" #include "MessageSupport.h" #include "OperationModes.h" +#include "PersistentAlarm.h" #include "Temperature.h" #include "Timers.h" #include "TaskPriority.h" +#include "TDInterface.h" #include "Utilities.h" /** @@ -34,9 +37,24 @@ #define TEMP_SENSORS_DATA_PUBLISH_INTERVAL ( MS_PER_SECOND / TASK_PRIORITY_INTERVAL ) ///< Temperature sensors publish data time interval. #define TEMP_SENSORS_FPGA_ERROR_TIMEOUT_MS ( 2 * MS_PER_SECOND ) ///< Temperature sensors FPGA error timeout in milliseconds. - +#define D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES 50 ///< D4 temperature sensor moving average number of samples. +#define D50_TEMP_MOVING_AVG_NUM_OF_SAMPLES 25 ///< D50 temperature sensor moving average number of samples ( 250ms filter ). #define DATA_PUBLISH_COUNTER_START_COUNT 30 ///< Data publish counter start count. +#define DIAL_TEMP_MOVING_AVG_NUM_OF_SAMPLES 30 ///< Dialysate temperature sensors moving average number of samples. +#define D28_D30_DATA_COLLECTION_TIME_MS ( 1 * MS_PER_SECOND ) ///< Dialysate temperature sensors data collection time in milliseconds. +#define D28_D30_TEMP_SENSORS_MAX_DEVIATION_C 3.0F ///< Dialysate temperature sensors maximum allowed deviation in C. +#define DIALYSATE_TEMP_SNSRS_OUT_OF_RANGE_TIMEOUT_MS ( 10 * MS_PER_SECOND ) ///< Dialysate temperature sensors drift timeout in milliseconds. +#define D28_D30_TEMP_SENSORS_MAX_DEVIATION_IN_HEAT_DIS_C 5.0F ///< Dialysate temperature sensors maximum allowed deviation in heat disinfect in C. +/// Dialysate temperature sensors enums +typedef enum dial_Temps_Sensors +{ + DIAL_TEMP_D28 = 0, ///< Dialysate temperature D28. + DIAL_TEMP_FIRST = DIAL_TEMP_D28, ///< Dialysate temperature first. + DIAL_TEMP_D30, ///< Dialysate temperature D30. + NUM_OF_DIAL_TEMPS ///< Number of Dialysate temperature sensors. +} DIAL_TEMPERATURE_SENSORS_T; + /// Temperature sensor exec states. typedef enum tempSensors_Exec_States { @@ -45,11 +63,38 @@ NUM_OF_TEMPSENSORS_EXEC_STATES, ///< Total number of exec states } TEMPSENSORS_EXEC_STATES_T; +/// Dialysate temperature moving average structure +typedef struct +{ + BOOL dialTempColHasTimerBeenSet; ///< Dialysate temperature has data collection timer started boolean flag. + U32 dialTempDataColStartTimeMS; ///< Dialysate temperature data collection start time in milliseconds. + F32 dialTempRunningSumC; ///< Dialysate temperature running sum in C. + F32 dialTempAvgC; ///< Dialysate temperature average in C. + F32 dialTempSamplesC[ DIAL_TEMP_MOVING_AVG_NUM_OF_SAMPLES ]; ///< Dialysate temperature samples array in C. + U32 dialTempSamplesNextIndex; ///< Dialysate temperature sample next index number. +} DIAL_TEMP_MOVING_AVG_DATA_T; + // ********** private data ********** static TEMPSENSORS_EXEC_STATES_T tempSensorsExecState; ///< TemperatureSensor exec state. -static U32 startTime; ///< star time to read FPGA values. +static U32 startTime; ///< start time to read FPGA values. +static BOOL tempDriftEventCheck; ///< Temperature sensor drift event boolean. +static DIAL_TEMP_MOVING_AVG_DATA_T dialTempMovingAvgData[ NUM_OF_DIAL_TEMPS ]; ///< Dialysate temperature moving average data. +static F32 d4TempAvgC; ///< D4 temperature average in C. +static F32 d4TempRunningSumC; ///< D4 temperature running sum in C. +static F32 d4TempSamplesC[ D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES ]; ///< D4 temperature samples array in C. +static U32 d4TempSamplesNextIndex; ///< D4 temperature sample next index number. +static U32 d4TempCount; ///< D4 Number of samples in average buffer. +static U32 tempDataColTimeInterval; ///< Temperature data collection time interval in milliseconds. +static U32 d4TempSampleIntervalCounter; ///< D4 temperature sensor sample collection timer counter. + +static F32 d50TempAvgC; ///< D50 temperature average in C. +static F32 d50TempRunningSumC; ///< D50 temperature running sum in C. +static F32 d50TempSamplesC[ D50_TEMP_MOVING_AVG_NUM_OF_SAMPLES ]; ///< D50 temperature samples array in C. +static U32 d50TempSamplesNextIndex; ///< D50 temperature sample next index number. +static U32 d50TempCount; ///< D50 Number of samples in average buffer. + static U32 dataPublicationTimerCounter; ///< Temperature sensors data publish timer counter. static OVERRIDE_U32_T tempSensorsPublishInterval = { TEMP_SENSORS_DATA_PUBLISH_INTERVAL, TEMP_SENSORS_DATA_PUBLISH_INTERVAL, 0, 0 }; ///< Temperature sensors publish time interval override. @@ -58,6 +103,9 @@ static TEMPSENSORS_EXEC_STATES_T handleExecStart( void ); static TEMPSENSORS_EXEC_STATES_T handleExecGetADCValues( void ); +static void filterTemperatureReadings( void ); +static void filterDialTemperatureReadings( void ); +static void getTempMovingAverageTimeInterval( void ); static void publishTemperatureSensorsData( void ); /*********************************************************************//** @@ -69,12 +117,29 @@ *************************************************************************/ void initTemperature( void ) { - startTime = 0; - tempSensorsExecState = TEMPSENSORS_EXEC_STATE_START; - dataPublicationTimerCounter = DATA_PUBLISH_COUNTER_START_COUNT; + startTime = 0; + tempSensorsExecState = TEMPSENSORS_EXEC_STATE_START; + dataPublicationTimerCounter = DATA_PUBLISH_COUNTER_START_COUNT; + d4TempRunningSumC = 0.0F; + d4TempAvgC = 0.0F; + d4TempSamplesNextIndex = 0; + d4TempCount = 0; + d50TempRunningSumC = 0.0F; + d50TempAvgC = 0.0F; + d50TempSamplesNextIndex = 0; + d50TempCount = 0; + d4TempSampleIntervalCounter = 0; + tempDataColTimeInterval = 0; + tempDriftEventCheck = FALSE; + dialTempMovingAvgData[ DIAL_TEMP_D28 ].dialTempColHasTimerBeenSet = FALSE; + dialTempMovingAvgData[ DIAL_TEMP_D30 ].dialTempColHasTimerBeenSet = FALSE; + // Initialize the temperature sensors initTemperatureSensors(); + + // Persistent alarm for the temperature sensors range check + initPersistentAlarm( ALARM_ID_DD_DIALYSATE_TEMPERATURE_SENSORS_OUT_OF_RANGE, 0, DIALYSATE_TEMP_SNSRS_OUT_OF_RANGE_TIMEOUT_MS ); } /*********************************************************************//** @@ -144,6 +209,12 @@ // Monitor the temperature values monitorTemperatureSenors(); + //Update the timeinterval + getTempMovingAverageTimeInterval(); + + // Filter D4/D50 temperature readings + filterTemperatureReadings(); + // Publish the data publishTemperatureSensorsData(); } @@ -194,6 +265,169 @@ /*********************************************************************//** * @brief + * The filterTemperatureReadings function adds a new temperature sensor + * sample to the filters. + * @details \b Inputs: D4 and D50 Temperature + * @details \b Outputs: d4TempSamplesC[], d4TempSamplesNextIndex, d4TempRunningSumC, + * d4TempCount, d4TempAvgC, d50TempSamplesC, d50TempRunningSumC, d50TempSamplesNextIndex, + * d50TempCount, d50TempAvgC + * @return none + *************************************************************************/ +static void filterTemperatureReadings( void ) +{ + // Moving average sample collection interval varies based on the dialysate flow rate + if ( ++d4TempSampleIntervalCounter >= tempDataColTimeInterval ) + { + // Filter D4 Temperature for AC heater + if ( d4TempCount >= D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES ) + { + d4TempRunningSumC -= d4TempSamplesC[ d4TempSamplesNextIndex ]; + } + + F32 d4Temp = getTemperatureValue( D4_TEMP ); + d4TempSamplesC[ d4TempSamplesNextIndex ] = d4Temp; + d4TempRunningSumC += d4Temp; + d4TempSamplesNextIndex = INC_WRAP( d4TempSamplesNextIndex, 0, D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES - 1 ); + d4TempCount = INC_CAP( d4TempCount, D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES ); + d4TempAvgC = d4TempRunningSumC / (F32)d4TempCount; + d4TempSampleIntervalCounter = 0; + } + + // Filter D50 Temperature ( 250 ms filter ) for trimmer heater + if ( d50TempCount >= D50_TEMP_MOVING_AVG_NUM_OF_SAMPLES ) + { + d50TempRunningSumC -= d50TempSamplesC[ d50TempSamplesNextIndex ]; + } + + F32 d50Temp = getTemperatureValue( D50_TEMP ); + d50TempSamplesC[ d50TempSamplesNextIndex ] = d50Temp; + d50TempRunningSumC += d50Temp; + d50TempSamplesNextIndex = INC_WRAP( d50TempSamplesNextIndex, 0, D50_TEMP_MOVING_AVG_NUM_OF_SAMPLES - 1 ); + d50TempCount = INC_CAP( d50TempCount, D50_TEMP_MOVING_AVG_NUM_OF_SAMPLES ); + d50TempAvgC = d50TempRunningSumC / (F32)d50TempCount; + + // dailysate temperature moving average + filterDialTemperatureReadings(); +} + +/*********************************************************************//** + * @brief + * The filterDialTemperatureReadings function adds a new dialysate temperature + * sensor sample to the filters. + * @details \b Inputs: dialysate temperature + * @details \b Outputs: dialTempMovingAvgData[] + * @return none + *************************************************************************/ +static void filterDialTemperatureReadings( void ) +{ + DIAL_TEMPERATURE_SENSORS_T i; + + for ( i = DIAL_TEMP_FIRST; i < NUM_OF_DIAL_TEMPS; i++ ) + { + if ( FALSE == dialTempMovingAvgData[ i ].dialTempColHasTimerBeenSet ) + { + dialTempMovingAvgData[ i ].dialTempDataColStartTimeMS = getMSTimerCount(); + dialTempMovingAvgData[ i ].dialTempColHasTimerBeenSet = TRUE; + } + else if ( TRUE == didTimeout( dialTempMovingAvgData[ i ].dialTempDataColStartTimeMS, D28_D30_DATA_COLLECTION_TIME_MS ) ) + { + CONDUCTIVITY_SENSORS_T sensor = ( DIAL_TEMP_D28 == i ? D27_COND : D29_COND ); + F32 temperatureC = getConductivityTemperatureValue( sensor ); + U32 currentIndex = dialTempMovingAvgData[ i ].dialTempSamplesNextIndex; + F32 prevSampleToRemoveC = dialTempMovingAvgData[ i ].dialTempSamplesC[ currentIndex ]; + + dialTempMovingAvgData[ i ].dialTempDataColStartTimeMS = getMSTimerCount(); + dialTempMovingAvgData[ i ].dialTempColHasTimerBeenSet = TRUE; + dialTempMovingAvgData[ i ].dialTempSamplesC[ currentIndex ] = temperatureC; + dialTempMovingAvgData[ i ].dialTempRunningSumC = dialTempMovingAvgData[ i ].dialTempRunningSumC + temperatureC - prevSampleToRemoveC; + dialTempMovingAvgData[ i ].dialTempSamplesNextIndex = INC_WRAP( dialTempMovingAvgData[ i ].dialTempSamplesNextIndex, 0, DIAL_TEMP_MOVING_AVG_NUM_OF_SAMPLES - 1 ); + dialTempMovingAvgData[ i ].dialTempAvgC = dialTempMovingAvgData[ i ].dialTempRunningSumC / (F32)DIAL_TEMP_MOVING_AVG_NUM_OF_SAMPLES; + } + } +} + +/*********************************************************************//** + * @brief + * The checkDialysateTemperatureSensors function checks whether the + * dialysate temperature sensors have drifted. If they are drifted, it raises + * an alarm. + * @details \b Inputs: dialysate temperature + * @details \b Outputs: None + * @return none + *************************************************************************/ +void checkDialysateTemperatureSensors( void ) +{ + DD_OP_MODE_T op = getCurrentOperationMode(); + + if ( ( DD_MODE_GEND == op ) || ( DD_MODE_HEAT == op ) ) + { + F32 d28Temp = dialTempMovingAvgData[ DIAL_TEMP_D28 ].dialTempAvgC; + F32 d30Temp = dialTempMovingAvgData[ DIAL_TEMP_D30 ].dialTempAvgC; + F32 driftC = ( DD_MODE_HEAT == op ? D28_D30_TEMP_SENSORS_MAX_DEVIATION_IN_HEAT_DIS_C : D28_D30_TEMP_SENSORS_MAX_DEVIATION_C ); + BOOL isDriftOut = ( fabs( d28Temp - d30Temp ) > driftC ? TRUE : FALSE ); + + checkPersistentAlarm( ALARM_ID_DD_DIALYSATE_TEMPERATURE_SENSORS_OUT_OF_RANGE, isDriftOut, fabs( d28Temp - d30Temp ), driftC ); + + if ( ( FALSE == tempDriftEventCheck ) && ( TRUE == isDriftOut ) ) + { + // Send event only condition trigger, not continuously. + tempDriftEventCheck = TRUE; + SEND_EVENT_WITH_2_U32_DATA(DD_EVENT_TEMPERATURE_DRIFT, d28Temp, d30Temp) + } + + if ( ( TRUE == tempDriftEventCheck ) && ( FALSE == isDriftOut ) ) + { + tempDriftEventCheck = FALSE; + } + } +} + +/*********************************************************************//** + * @brief + * The getD4AverageTemperature function returns the average temperature + * for D4 temp sensor. + * @details \b Inputs: none + * @details \b Outputs: none + * @return the D4 average temperature + *************************************************************************/ +F32 getD4AverageTemperature( void ) +{ + return d4TempAvgC; +} + +/*********************************************************************//** + * @brief + * The getD50AverageTemperature function returns the average temperature + * for D50 temp sensor. + * @details \b Inputs: none + * @details \b Outputs: none + * @return the D50 average temperature + *************************************************************************/ +F32 getD50AverageTemperature( void ) +{ + return d50TempAvgC; +} + +/*********************************************************************//** + * @brief + * The getTempMovingAverageTimeInterval function calculates the temperature + * interval used for sample collection based on the dialysate flow rate, + * to find the average value. + * @details \b Inputs: dialysate flow rate + * @details \b Outputs: none + * @return the temperature interval for sample collection in task interval + *************************************************************************/ +static void getTempMovingAverageTimeInterval( void ) +{ + F32 period = (F32)SEC_PER_MIN / ( getTDDialysateFlowrate() / BAL_CHAMBER_FILL_VOLUME_ML ) ; + + U32 sampleInterval = (U32)( ( period / (F32)D4_TEMP_MOVING_AVG_NUM_OF_SAMPLES ) * MS_PER_SECOND ); + + tempDataColTimeInterval = (U32) ( sampleInterval / TASK_PRIORITY_INTERVAL ); +} + +/*********************************************************************//** + * @brief * The publishTemperatureSensorsData function broadcasts the temperature * sensors data at the publication interval. * @details \b Inputs: dataPublicationTimerCounter and publish interval time. @@ -218,6 +452,11 @@ data.d28CondTemp = getConductivityTemperatureValue( D27_COND ); data.d30CondTemp = getConductivityTemperatureValue( D29_COND ); data.d44CondTemp = getConductivityTemperatureValue( D43_COND ); + data.d75CondTemp = getConductivityTemperatureValue( D74_COND ); + data.d4AvgTemp = getD4AverageTemperature(); + data.d50AvgTemp = getD50AverageTemperature(); + data.d28AvgTemp = dialTempMovingAvgData[ DIAL_TEMP_D28 ].dialTempAvgC; + data.d30AvgTemp = dialTempMovingAvgData[ DIAL_TEMP_D30 ].dialTempAvgC; broadcastData( MSG_ID_DD_TEMPERATURE_DATA, COMM_BUFFER_OUT_CAN_DD_BROADCAST, (U08*)&data, sizeof( TEMPERATURE_SENSORS_DATA_T ) ); dataPublicationTimerCounter = 0;