Index: firmware/App/Services/Reservoirs.c =================================================================== diff -u -rd611c5eeaee076a6fbf79cf94f80fff05fd5d9a9 -re2cf7feff54dad3fc5be72619fa64b5421fc6f9f --- firmware/App/Services/Reservoirs.c (.../Reservoirs.c) (revision d611c5eeaee076a6fbf79cf94f80fff05fd5d9a9) +++ firmware/App/Services/Reservoirs.c (.../Reservoirs.c) (revision e2cf7feff54dad3fc5be72619fa64b5421fc6f9f) @@ -7,8 +7,8 @@ * * @file Reservoirs.c * -* @author (last) Michael Garthwaite -* @date (last) 18-Aug-2023 +* @author (last) Dara Navaei +* @date (last) 19-Sep-2023 * * @author (original) Dara Navaei * @date (original) 21-Nov-2021 @@ -29,6 +29,11 @@ #include "TaskGeneral.h" #include "Timers.h" +/** + * @addtogroup Reservoirs + * @{ + */ + // ********** private definitions ********** #define RESERVOIR_FRESH_SETTLE_TIME_MS 15000 ///< Allocated time to settle the freshly filled reservoir in milliseconds. @@ -58,6 +63,7 @@ #define DIA_FLOW_TO_FILL_FLOW_CONSTANT 2.0F ///< Dialysate flow rate to fill flow rate constant. #define MAX_RESERVOIR_VOL_BEFORE_SWITCH_ML 1900.0F ///< Maximum reservoir volume before we switch reservoirs (in mL). +#define FILL_VOLUME_INTERCEPT_ML_QD_ABOVE_400_MLPM 1100 ///< Fill volume intercept in milliliters for Qd above 400 mL/min. // ********** private data ********** @@ -93,6 +99,7 @@ static U32 previousDialysateFlowMLP; ///< Previous dialysate flow rate in mL/min. static F32 previousUFFlowMLP; ///< Previous ultrafiltration flow rate in mL/min. static DG_MIXING_RATIOS_T ratios; ///< Mixing ratios and fill prep time in milliseconds structure. +static U32 prevTargetFillVolumeML[ NUM_OF_DG_RESERVOIRS ]; ///< Previous target fill volume in milliliters. static const F32 RESERVOIR_DILUTION_RATIO = MAX_RESERVOIR_DILUTION / ( 1.0 - MAX_RESERVOIR_DILUTION ); ///< Reservoir dilution ratio. @@ -106,6 +113,7 @@ static F32 getReservoirRecirculationMaxPercent( void ); static void publishReservoirData( void ); static BOOL isDialysateTempAlarmActive( void ); +static U32 getTargetFillVolumeBasedOnDialysateFlowML( void ); static TREATMENT_RESERVOIR_MGMT_STATE_T handleReservoirMgmtStartState( void ); static TREATMENT_RESERVOIR_MGMT_STATE_T handleReservoirMgmtDrainState( void ); @@ -123,7 +131,7 @@ * volSpentMl, reservoirsPublicationCounter, dilutionLevelPct, dgOpMode, dgSubMode, * timeReservoirInUse, volSpentUFML, activeReservoir, recirculationLevelPct, * reservoirSwitchStartTimeMS, timeWaitToFillMS, targetFillFlowLPM, ratios - * previousDialysateFlowRate + * previousDialysateFlowRate, prevTargetFillVolumeML * @return none *************************************************************************/ void initReservoirs( void ) @@ -151,6 +159,10 @@ ratios.acidMixingRatio = 0.0F; ratios.bicarbMixingRatio = 0.0F; ratios.timeFillPrepMS = 0; + + // Initialize the previous reservoir fill volume + prevTargetFillVolumeML[ DG_RESERVOIR_1 ] = FILL_RESERVOIR_TO_VOLUME_ML; + prevTargetFillVolumeML[ DG_RESERVOIR_2 ] = FILL_RESERVOIR_TO_VOLUME_ML; } /*********************************************************************//** @@ -170,8 +182,9 @@ * @brief * The execReservoirs function executes the state machine for the treatment * reservoir management during treatment mode. - * @details Inputs: reservoirsState - * @details Outputs: reservoirsState, timeReservoirInUse, volSpentML, recirculationLevelPct + * @details Inputs: reservoirsState, prevTargetFillVolumeML + * @details Outputs: reservoirsState, timeReservoirInUse, volSpentML, + * recirculationLevelPct * @return none *************************************************************************/ void execReservoirs( void ) @@ -194,7 +207,7 @@ volSpentML += ( flowRateMLPerMS * msSinceLastVolumeCalc ); timeReservoirInUse++; // Check the recirculation level - recirculationLevelPct = volSpentML / (F32)FILL_RESERVOIR_TO_VOLUME_ML; + recirculationLevelPct = volSpentML / (F32)prevTargetFillVolumeML[ getDGActiveReservoir() ]; } // Update the reservoir start time @@ -302,7 +315,7 @@ /*********************************************************************//** * @brief * The getFillTimeMS function calculates the fill time in milliseconds. - * @details Inputs: ratios + * @details Inputs: targetFillFlowRate, prevTargetFillVolumeML * @details Outputs: none * @return target maximum fill time *************************************************************************/ @@ -314,7 +327,7 @@ F32 totalTargetFillFlow = targetFillFlowRate + ( targetFillFlowRate * ratios.acidMixingRatio ) + ( targetFillFlowRate * ratios.bicarbMixingRatio ); // Time fill = Fill volume / Qfill. Qfill is converted from L/min to mL/min and the time is converted from minutes to milliseconds - U32 timeFillMS = ( FILL_RESERVOIR_TO_VOLUME_ML / ( ML_PER_LITER * totalTargetFillFlow ) ) * SEC_PER_MIN * MS_PER_SECOND; + U32 timeFillMS = ( getTargetFillVolumeBasedOnDialysateFlowML() / ( ML_PER_LITER * totalTargetFillFlow ) ) * SEC_PER_MIN * MS_PER_SECOND; // Add the prepare time in the DG mode fill to the calculated fill time in milliseconds U32 timeTotalFillMS = timeFillMS + ratios.timeFillPrepMS; @@ -328,27 +341,29 @@ * flow has changed the function sends the new active reservoir cycle time * to the DG. * @details Inputs: previousDialysateFlowMLP, previousUFFlowMLP - * @details Outputs: previousDialysateFlowMLP, previousUFFlowMLP, volSpentUFML, timeDepleteMS + * @details Outputs: previousDialysateFlowMLP, previousUFFlowMLP, volSpentUFML, + * timeDepleteMS, prevTargetFillVolumeML * @return none *************************************************************************/ static void calculateActiveReservoirCycleTime( void ) { + U32 activeRsrvrTgtVolML = prevTargetFillVolumeML[ getDGActiveReservoir() ]; U32 dialysateFlowMLP = getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ); - F32 fillTimeMS = ( (F32)FILL_RESERVOIR_TO_VOLUME_ML / ( getTargetFillFlowRateLPM() * ML_PER_LITER ) ) * SEC_PER_MIN * MS_PER_SECOND; + F32 fillTimeMS = ( (F32)activeRsrvrTgtVolML / ( getTargetFillFlowRateLPM() * ML_PER_LITER ) ) * SEC_PER_MIN * MS_PER_SECOND; F32 targetUFFlowMLP = getCurrentUFSetRate(); - F32 timeDepletionMS = ( (F32)FILL_RESERVOIR_TO_VOLUME_ML / dialysateFlowMLP ) * SEC_PER_MIN * MS_PER_SECOND; + F32 timeDepletionMS = ( (F32)activeRsrvrTgtVolML / dialysateFlowMLP ) * SEC_PER_MIN * MS_PER_SECOND; F32 timeTotalCycleMS = fillTimeMS + RESERVOIR_FRESH_SETTLE_TIME_MS + RESERVOIR_CYCLE_EXTRA_MARGIN_TIME_MS + ratios.timeFillPrepMS; F32 timeReservoirCycleMS = 0.0F; F32 timeUFDepletionMS = NEARLY_INFINITY; - F32 volFreshML = FILL_RESERVOIR_TO_VOLUME_ML - volSpentML; + F32 volFreshML = activeRsrvrTgtVolML - volSpentML; F32 timeFreshRemainingMS = ( volFreshML / (F32)dialysateFlowMLP ) * SEC_PER_MIN * MS_PER_SECOND; - F32 volMaxUFML = FILL_RESERVOIR_TO_VOLUME_ML * MAX_RESERVOIR_DILUTION; + F32 volMaxUFML = activeRsrvrTgtVolML * MAX_RESERVOIR_DILUTION; // Check if target UF flow is not zero to consider it in the calculations too if ( targetUFFlowMLP > NEARLY_ZERO ) { // If UF is not 0, the active reservoir cycle time is minimum of UF depletion and fill time - timeUFDepletionMS = ( ( (F32)FILL_RESERVOIR_TO_VOLUME_ML * RESERVOIR_DILUTION_RATIO ) / targetUFFlowMLP ) * SEC_PER_MIN * MS_PER_SECOND; + timeUFDepletionMS = ( ( (F32)activeRsrvrTgtVolML * RESERVOIR_DILUTION_RATIO ) / targetUFFlowMLP ) * SEC_PER_MIN * MS_PER_SECOND; // Calculate the ultra-filtration remaining volume // Using the ultra-filtration remaining volume and the ultra-filtration target flow rate calculate the time // The depletion time in milliseconds is the minimum time of the fresh remaining time and the depletion remaining time @@ -513,29 +528,33 @@ TREATMENT_RESERVOIR_MGMT_STATE_T state = TREATMENT_RESERVOIR_MGMT_WAIT_TO_FILL_STATE; // Get the target fill flow rate in L/min - F32 targetFillFlowRateLPM = getTargetFillFlowRateLPM(); + F32 targetFillFlowRateLPM = getTargetFillFlowRateLPM(); + DG_RESERVOIR_ID_T inactiveRsrvr = getDGInactiveReservoir(); + DG_RESERVOIR_ID_T activeRsrvr = getDGActiveReservoir(); // Get the ultra-filtration volume milliliters // Get the dilution level in percent = spent ultra-filtration volume / target fill volume in milliliters volSpentUFML = getReservoirUltrafiltrationVol( activeReservoir ); - dilutionLevelPct = volSpentUFML / (F32)FILL_RESERVOIR_TO_VOLUME_ML; + dilutionLevelPct = volSpentUFML / (F32)prevTargetFillVolumeML[ activeRsrvr ]; // Check if the dilution level has exceeded the limit or the spent volume is more than the amount of volume in the reservoir // If it has, trigger the fill command. This if should not happen and the predictive dilution level should trigger just in time // in advance - if ( ( dilutionLevelPct >= MAX_RESERVOIR_DILUTION ) || ( volSpentML >= (F32)FILL_RESERVOIR_TO_VOLUME_ML ) ) + if ( ( dilutionLevelPct >= MAX_RESERVOIR_DILUTION ) || ( volSpentML >= (F32)prevTargetFillVolumeML[ activeRsrvr ] ) ) { if ( DG_GEN_IDLE_MODE_STATE_FLUSH_WATER == dgSubMode ) { - cmdStartDGFill( FILL_RESERVOIR_TO_VOLUME_ML, targetFillFlowRateLPM ); + prevTargetFillVolumeML[ inactiveRsrvr ] = getTargetFillVolumeBasedOnDialysateFlowML(); + cmdStartDGFill( prevTargetFillVolumeML[ inactiveRsrvr ], targetFillFlowRateLPM ); } } // If we have active dialysate temp alarms, we want to fill immediately. else if ( TRUE == isDialysateTempAlarmActive() ) { if ( DG_GEN_IDLE_MODE_STATE_FLUSH_WATER == dgSubMode ) { - cmdStartDGFill( FILL_RESERVOIR_TO_VOLUME_ML, targetFillFlowRateLPM ); + prevTargetFillVolumeML[ inactiveRsrvr ] = getTargetFillVolumeBasedOnDialysateFlowML(); + cmdStartDGFill( prevTargetFillVolumeML[ inactiveRsrvr ], targetFillFlowRateLPM ); } } else @@ -548,7 +567,8 @@ // If the wait time has elapsed, trigger a fill command if ( timeWaitToFillMS <= 0 ) { - cmdStartDGFill( FILL_RESERVOIR_TO_VOLUME_ML, targetFillFlowRateLPM ); + prevTargetFillVolumeML[ inactiveRsrvr ] = getTargetFillVolumeBasedOnDialysateFlowML(); + cmdStartDGFill( prevTargetFillVolumeML[ inactiveRsrvr ], targetFillFlowRateLPM ); } } @@ -613,25 +633,25 @@ static TREATMENT_RESERVOIR_MGMT_STATE_T handleReservoirMgmtWaitForFillSettleState( void ) { TREATMENT_RESERVOIR_MGMT_STATE_T state = TREATMENT_RESERVOIR_MGMT_WAIT_FOR_FILL_SETTLE_STATE; - DG_RESERVOIR_ID_T active = getDGActiveReservoir(); + DG_RESERVOIR_ID_T active = getDGActiveReservoir(); + DG_RESERVOIR_ID_T inactiveRsrvr = getDGInactiveReservoir(); // Get the ultra-filtration volume milliliters // Get the dilution level in percent = spent ultra-filtration volume / target fill volume in milliliters volSpentUFML = getReservoirUltrafiltrationVol( activeReservoir ); - dilutionLevelPct = volSpentUFML / (F32)FILL_RESERVOIR_TO_VOLUME_ML; + dilutionLevelPct = volSpentUFML / (F32)prevTargetFillVolumeML[ active ]; // Wait for the reservoir to settle and then send the commands to switch the active reservoir if ( ( TRUE == didTimeout( reservoirSwitchStartTimeMS, RESERVOIR_FRESH_SETTLE_TIME_MS ) ) && - ( ( dilutionLevelPct >= MAX_RESERVOIR_DILUTION ) || ( volSpentML >= (F32)FILL_RESERVOIR_TO_VOLUME_ML ) || ( TRUE == isDialysateTempAlarmActive() ) ) ) + ( ( dilutionLevelPct >= MAX_RESERVOIR_DILUTION ) || ( volSpentML >= (F32)getTargetFillVolumeBasedOnDialysateFlowML() ) || ( TRUE == isDialysateTempAlarmActive() ) ) ) { DG_SWITCH_RSRVRS_CMD_T rsrvrCmd; - DG_RESERVOIR_ID_T inactiveRes = getDGInactiveReservoir(); - rsrvrCmd.reservoirID = (U32)inactiveRes; + rsrvrCmd.reservoirID = (U32)inactiveRsrvr; rsrvrCmd.useLastTrimmerHeaterDC = TRUE; // Signal dialysis sub-mode to capture baseline volume for next reservoir. - setStartReservoirVolume( inactiveRes ); + setStartReservoirVolume( inactiveRsrvr ); // Command DG to switch reservoirs cmdSetDGActiveReservoir( &rsrvrCmd ); @@ -646,7 +666,6 @@ reservoirSwitchStartTimeMS = getMSTimerCount(); state = TREATMENT_RESERVOIR_MGMT_WAIT_FOR_SWITCH_SETTLE_STATE; - } return state; @@ -703,4 +722,25 @@ return result; } +/*********************************************************************//** + * @brief + * The getTargetFillVolumeBasedOnDialysateFlowML function calculates the + * target fill volume in milliliters. + * @details Inputs: none + * @details Outputs: none + * @return Fill target volume in milliliters + *************************************************************************/ +static U32 getTargetFillVolumeBasedOnDialysateFlowML( void ) +{ + U32 targetFillVolumeML = FILL_RESERVOIR_TO_VOLUME_ML; + U32 dialysateFlowMLP = getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ); + + if ( dialysateFlowMLP >= RESERVOIR_FLOW_400_MLP ) + { + targetFillVolumeML = dialysateFlowMLP + FILL_VOLUME_INTERCEPT_ML_QD_ABOVE_400_MLPM; + } + + return targetFillVolumeML; +} + /**@}*/