Index: firmware/App/Modes/ModeTreatment.c =================================================================== diff -u -rda59fa4a98dbc11c37677e92a66aa940d251678f -rd387dc3cd21e6f1fb7e161032f30eb49a9c1b48e --- firmware/App/Modes/ModeTreatment.c (.../ModeTreatment.c) (revision da59fa4a98dbc11c37677e92a66aa940d251678f) +++ firmware/App/Modes/ModeTreatment.c (.../ModeTreatment.c) (revision d387dc3cd21e6f1fb7e161032f30eb49a9c1b48e) @@ -28,6 +28,7 @@ #include "Pressures.h" #include "StateTxBloodPrime.h" #include "StateTxDialysis.h" +#include "StateTxIsolatedUF.h" #include "StateTxPaused.h" //#include "Switches.h" #include "TaskGeneral.h" @@ -81,6 +82,7 @@ static U32 treatmentStateBroadcastTimerCtr; ///< Treatment state data broadcast timer counter used to schedule when to transmit data. static U32 treatmentParamsRangesBroadcastTimerCtr; ///< Treatment parameter ranges broadcast timer counter used to schedule when to transmit updated ranges. static U32 ultrafiltrationBroadcastTimerCtr; ///< Ultrafiltration data broadcast timer counter used to schedule when to transmit data. +static U32 isolatedUFBroadcastTimerCtr; ///< Isolated UF data broadcast timer counter used to schedule when to transmit data. static U32 salineBolusBroadcastTimerCtr; ///< Saline bolus data broadcast timer counter used to schedule when to transmit data. /// Interval (in task intervals) at which to publish alarm status to CAN bus. @@ -96,6 +98,12 @@ static BOOL endTreatmentRequest; ///< Flag indicates user has requested end of treatment from rinseback workflow. static BOOL bloodPrimeToDialysisRequest; ///< Flag indicates blood prime has completed and time to start dialysis. static BOOL resumeBlockedByAlarm; ///< Flag indicates an alarm has blocked resume of this treatment. +static TREATMENT_STATE_T treatmentStateBeforePause; ///< Treatment state to return to after treatment paused state. +static BOOL isolatedUFStartRequested; ///< Flag indicates isolated UF should start. +static BOOL isolatedUFMidTreatment; ///< Flag indicates isolated UF was started during HD/HDF treatment. +static U32 isolatedUFDurationMin; ///< Isolated UF duration in minutes. +static F32 isolatedUFSetVolumeMl; ///< Isolated UF set volume in mL. +static F32 isolatedUFRateMlMin; ///< Isolated UF rate in mL/min. static U32 treatmentStartTimeStamp; ///< Treatment start timestamp for logging purpose. static U32 treatmentEndTimeStamp; ///< Treatment end timestamp for logging purpose. @@ -106,6 +114,7 @@ static void broadcastTreatmentPeriodicData(); static void publishSalineBolusData( void ); // TODO - move to StateTxSalineBolus.c when implemented static void publishUltrafiltrationData( void ); +static void publishIsolatedUFData( void ); static U32 getMinTreatmentTimeInMinutes( void ); static TREATMENT_STATE_T handleTreatmentStartState( void ); static TREATMENT_STATE_T handleTreatmentBloodPrimeState( void ); @@ -117,8 +126,10 @@ static TREATMENT_STATE_T handleTreatmentRinsebackState( void ); static TREATMENT_STATE_T handleTreatmentRecircState( void ); static TREATMENT_STATE_T handleTreatmentEndState( void ); +static TREATMENT_STATE_T enterTreatmentPausedState( void ); static void resetSignalFlags( void ); static void resetAlarmSignalFlags( void ); +static void resumeDialysisAfterIsolatedUF( void ); /*********************************************************************//** * @brief @@ -135,6 +146,8 @@ treatmentCompleted = FALSE; rinsebackDone = FALSE; resumeBlockedByAlarm = FALSE; + isolatedUFStartRequested = FALSE; + isolatedUFMidTreatment = FALSE; treatmentTimePublishInterval.data = TREATMENT_TIME_DATA_PUB_INTERVAL; treatmentTimePublishInterval.ovData = TREATMENT_TIME_DATA_PUB_INTERVAL; @@ -155,11 +168,15 @@ treatmentStateBroadcastTimerCtr = TREATMENT_STATE_DATA_PUB_INTERVAL; // So we send state data immediately when we begin treatment mode treatmentParamsRangesBroadcastTimerCtr = TREATMENT_SETTINGS_RANGES_PUB_INTERVAL; // So we send ranges immediately when we begin treatment mode ultrafiltrationBroadcastTimerCtr = ULTRAFILTRATION_DATA_PUB_INTERVAL; // So we send ultrafiltration immediately when we begin treatment mode + isolatedUFBroadcastTimerCtr = ULTRAFILTRATION_DATA_PUB_INTERVAL; // So we send isolated UF immediately when we enter isolated UF salineBolusBroadcastTimerCtr = SALINE_BOLUS_DATA_PUB_INTERVAL; // So we send saline bolus data immediately when we begin treatment mode presTreatmentTimeSecs = 0; presUFVolumeMl = 0.0F; presUFRateMlMin = 0.0F; + isolatedUFDurationMin = 0; + isolatedUFSetVolumeMl = 0.0F; + isolatedUFRateMlMin = 0.0F; resetSignalFlags(); resetAlarmSignalFlags(); @@ -170,6 +187,22 @@ /*********************************************************************//** * @brief + * The enterTreatmentPausedState function saves the current treatment sub-state + * and transitions to the treatment paused sub-mode. + * @details \b Inputs: currentTreatmentState + * @details \b Outputs: treatmentStateBeforePause, treatment paused sub-mode entered + * @return TREATMENT_PAUSED_STATE + *************************************************************************/ +static TREATMENT_STATE_T enterTreatmentPausedState( void ) +{ + treatmentStateBeforePause = currentTreatmentState; + transitionToTreatmentPaused(); + + return TREATMENT_PAUSED_STATE; +} + +/*********************************************************************//** + * @brief * The transitionToTreatmentMode function prepares for transition to treatment * mode. * @details \b Inputs: none @@ -189,6 +222,7 @@ // Initialize treatment sub-modes each time we transition to treatment mode initBloodPrime(); initDialysis(); + initIsolatedUF(); initTreatmentPaused(); // initRinseback(); // initTreatmentRecirc(); @@ -212,8 +246,15 @@ setDialysisDDParams( getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ), presUFVolumeMl, presUFRateMlMin ); bicarbConvFactor = BICARBONATE_CONVERSION_FACTOR; - // Direct DD to generate dialysate and bypass while priming blood - cmdStartGenerateDialysate( (F32)getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ), presUFRateMlMin, + if ( TREATMENT_MODALITY_ISOLATED_UF == getTreatmentParameterU32( TREATMENT_PARAM_TREATMENT_MODALITY ) ) + { + setIsolatedUFSettings( getTreatmentParameterU32( TREATMENT_PARAM_TREATMENT_DURATION ), presUFVolumeMl ); + presUFRateMlMin = getIsolatedUFRateMlMin(); + } + + // Direct DD to generate dialysate and bypass while priming blood. + cmdStartGenerateDialysate( (F32)getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ), + ( TREATMENT_MODALITY_ISOLATED_UF == getTreatmentParameterU32( TREATMENT_PARAM_TREATMENT_MODALITY ) ? 0.0F : presUFRateMlMin ), getTreatmentParameterF32( TREATMENT_PARAM_DIALYSATE_TEMPERATURE ), TRUE, getTreatmentParameterF32( TREATMENT_PARAM_ACID_CONCENTRATE_CONV_FACTOR ), bicarbConvFactor, @@ -324,6 +365,123 @@ /*********************************************************************//** * @brief + * The setIsolatedUFSettings function sets isolated UF duration, volume goal, + * and rate without changing the normal treatment UF prescription. + * @details \b Inputs: durationMin, ufVolumeMl + * @details \b Outputs: isolatedUFDurationMin, isolatedUFSetVolumeMl, + * isolatedUFRateMlMin + * @param durationMin Isolated UF duration in minutes. + * @param ufVolumeMl Isolated UF volume goal in mL. + * @return TRUE if the isolated UF settings were updated, FALSE otherwise. + *************************************************************************/ +BOOL setIsolatedUFSettings( U32 durationMin, F32 ufVolumeMl ) +{ + BOOL result = FALSE; + + if ( durationMin > 0U ) + { + isolatedUFDurationMin = durationMin; + isolatedUFSetVolumeMl = ufVolumeMl; + isolatedUFRateMlMin = calculateIsolatedUFRateMlMin( durationMin, ufVolumeMl ); + + if ( TREATMENT_ISO_UF_STATE == currentTreatmentState ) + { + if ( ISOLATED_UF_PAUSED_STATE == getCurrentIsolatedUFState() ) + { + cmdChangeQuf( 0.0F ); + } + else + { + cmdChangeQuf( isolatedUFRateMlMin ); + } + } + + result = TRUE; + } + + return result; +} + +/*********************************************************************//** + * @brief + * The signalStartIsolatedUF function requests transition to isolated UF. + * @details \b Inputs: none + * @details \b Outputs: isolatedUFStartRequested, isolatedUFMidTreatment + * @param midTreatment TRUE when resuming HD/HDF after iso UF; FALSE for post-treatment or standalone exit to POST. + * @return none + *************************************************************************/ +void signalStartIsolatedUF( BOOL midTreatment ) +{ + isolatedUFMidTreatment = midTreatment; + isolatedUFStartRequested = TRUE; +} + +/*********************************************************************//** + * @brief + * The isIsolatedUFMidTreatment function determines whether isolated UF was + * started during an active HD/HDF treatment session. + * @details \b Inputs: isolatedUFMidTreatment + * @details \b Outputs: none + * @return TRUE if isolated UF was started mid-treatment, FALSE otherwise. + *************************************************************************/ +BOOL isIsolatedUFMidTreatment( void ) +{ + return isolatedUFMidTreatment; +} + +/*********************************************************************//** + * @brief + * The getIsolatedUFDurationMin function gets isolated UF duration. + * @details \b Inputs: isolatedUFDurationMin + * @details \b Outputs: none + * @return isolated UF duration in minutes. + *************************************************************************/ +U32 getIsolatedUFDurationMin( void ) +{ + return isolatedUFDurationMin; +} + +/*********************************************************************//** + * @brief + * The getIsolatedUFSetVolumeMl function gets isolated UF set volume. + * @details \b Inputs: isolatedUFSetVolumeMl + * @details \b Outputs: none + * @return isolated UF set volume in mL. + *************************************************************************/ +F32 getIsolatedUFSetVolumeMl( void ) +{ + return isolatedUFSetVolumeMl; +} + +/*********************************************************************//** + * @brief + * The getIsolatedUFRateMlMin function gets isolated UF rate. + * @details \b Inputs: isolatedUFRateMlMin + * @details \b Outputs: none + * @return isolated UF rate in mL/min. + *************************************************************************/ +F32 getIsolatedUFRateMlMin( void ) +{ + return isolatedUFRateMlMin; +} + +/*********************************************************************//** + * @brief + * The resumeDialysisAfterIsolatedUF function restores normal HD/HDF dialysis + * after a mid-treatment isolated UF session. Prescribed UF rate and Qd stored + * in the dialysis sub-mode are reapplied to the DD. + * @details \b Inputs: setDialysateFlowRate, setUFRateMlMin from setDialysisDDParams + * @details \b Outputs: isolatedUFMidTreatment cleared, DD returned to dialysis mode + * @return none + *************************************************************************/ +static void resumeDialysisAfterIsolatedUF( void ) +{ + isolatedUFMidTreatment = FALSE; + transitionToDialysis(); +} + +/*********************************************************************//** + * @brief * The setBloodIsPrimed function sets that flag indicating whether the * blood-side circuit has been primed with blood. Call this function with * TRUE when blood prime operation is completed. Call this function with @@ -463,10 +621,10 @@ currentTreatmentState = handleTreatmentDialysisState(); break; -// case TREATMENT_ISO_UF_STATE: -// currentTreatmentState = handleTreatmentIsoUFState(); -// break; -// + case TREATMENT_ISO_UF_STATE: + currentTreatmentState = handleTreatmentIsoUFState(); + break; + // case TREATMENT_SALINE_BOLUS_STATE: // currentTreatmentState = handleTreatmentSalineBolusState(); // break; @@ -507,6 +665,8 @@ broadcastTreatmentPeriodicData(); // Publish ultrafiltration data at set interval (whether we are performing UF or not) publishUltrafiltrationData(); + // Publish isolated UF data only while isolated UF is active + publishIsolatedUFData(); // Publish saline bolus data at set interval (whether we are delivering one or not) publishSalineBolusData(); @@ -593,18 +753,28 @@ if ( TRUE == bloodPrimeToDialysisRequest ) { lastTreatmentTimeStamp = getMSTimerCount(); - // Kick dialysis sub-mode off - setDialysisBloodPumpFlowRate( getTreatmentParameterU32( TREATMENT_PARAM_BLOOD_FLOW ) ); -// setDialysisDialInFlowAndUFRate( getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ), presMaxUFVolumeML, presUFRate ); + + if ( TREATMENT_MODALITY_ISOLATED_UF == getTreatmentParameterU32( TREATMENT_PARAM_TREATMENT_MODALITY ) ) + { + isolatedUFMidTreatment = FALSE; + transitionToIsolatedUF(); + result = TREATMENT_ISO_UF_STATE; + } + else + { + // Kick dialysis sub-mode off + setDialysisBloodPumpFlowRate( getTreatmentParameterU32( TREATMENT_PARAM_BLOOD_FLOW ) ); +// setDialysisDialInFlowAndUFRate( getTreatmentParameterU32( TREATMENT_PARAM_DIALYSATE_FLOW ), presMaxUFVolumeML, presUFRate ); // -// if ( presUFRate > 0.0 ) -// { -// sendTreatmentLogEventData( UF_START_RESUME_EVENT, 0.0, presUFRate ); -// } - transitionToDialysis(); -// // To update partial blood pump occlusion baseline - start of treatment -// signalBloodPumpPressureOcclBaseline(); - result = TREATMENT_DIALYSIS_STATE; +// if ( presUFRate > 0.0 ) +// { +// sendTreatmentLogEventData( UF_START_RESUME_EVENT, 0.0, presUFRate ); +// } + transitionToDialysis(); +// // To update partial blood pump occlusion baseline - start of treatment +// signalBloodPumpPressureOcclBaseline(); + result = TREATMENT_DIALYSIS_STATE; + } } } @@ -637,17 +807,93 @@ treatmentCompleted = TRUE; // sendLastTreatmentPeriodicData = TRUE; // treatmentEndTimeStamp = getRTCTimestamp(); - pauseDialysis(); - requestNewOperationMode( MODE_STAN ); // TODO transitionToTreatmentEnd(); - //SET_ALARM_WITH_1_U32_DATA( ALARM_ID_TD_END_OF_TREATMENT_WARNING, presTreatmentTimeSecs ); + cmdBypassDialyzer( TRUE ); + cmdChangeQuf( 0.0F ); + cmdChangeQd( 0.0F ); + + // Post-treatment iso UF (partial): stay in END and wait for UI 0x9F confirm or decline. + // Decline calls signalEndTreatment() -> MODE_POST. Full treatment-end sub-mode (rinseback + // etc. in handleTreatmentEndState) is not implemented yet — uncomment that block when ready. + // Until UI post-treatment flow is complete, previous behavior was: + // pauseDialysis(); + // requestNewOperationMode( MODE_STAN ); result = TREATMENT_END_STATE; } // Otherwise, execute state machine for treatment dialysis sub-mode else { - execDialysis(); + if ( TRUE == isolatedUFStartRequested ) + { + isolatedUFStartRequested = FALSE; + transitionToIsolatedUF(); + result = TREATMENT_ISO_UF_STATE; + } + else + { + execDialysis(); + // Handle alarm page + if ( TRUE == doesAlarmStatusIndicateStop() ) + { + transitionToTreatmentPaused(); + result = TREATMENT_PAUSED_STATE; + } + } + } + + return result; +} + +/*********************************************************************//** + * @brief + * The handleTreatmentIsoUFState function handles isolated ultrafiltration. + * @details \b Inputs: treatmentTimeMS, lastTreatmentTimeStamp + * @details \b Outputs: treatmentTimeMS, isolated UF sub-mode executed + * @return next treatment mode state + *************************************************************************/ +static TREATMENT_STATE_T handleTreatmentIsoUFState( void ) +{ + TREATMENT_STATE_T result = TREATMENT_ISO_UF_STATE; + U32 newTime = getMSTimerCount(); + U32 msSinceLast = calcTimeBetween( lastTreatmentTimeStamp, newTime ); + + // Update treatment time + treatmentTimeMS += msSinceLast; + lastTreatmentTimeStamp = newTime; + + // Prescribed HD/HDF time elapsed during mid-treatment iso UF: end iso UF and wait in END for post-treatment iso UF or POST. + if ( ( TRUE == isIsolatedUFMidTreatment() ) && + ( CALC_ELAPSED_TREAT_TIME_IN_SECS() >= presTreatmentTimeSecs ) ) + { + treatmentCompleted = TRUE; + endIsolatedUFOnUserStop(); + isolatedUFMidTreatment = FALSE; + cmdBypassDialyzer( TRUE ); + cmdChangeQuf( 0.0F ); + cmdChangeQd( 0.0F ); + result = TREATMENT_END_STATE; + } + else + { + execIsolatedUF(); + + if ( TRUE == isIsolatedUFCompleted() ) + { + if ( TRUE == isIsolatedUFMidTreatment() ) + { + resumeDialysisAfterIsolatedUF(); + result = TREATMENT_DIALYSIS_STATE; + } + else + { + treatmentCompleted = TRUE; + cmdBypassDialyzer( TRUE ); + cmdChangeQuf( 0.0F ); + requestNewOperationMode( MODE_POST ); + result = TREATMENT_END_STATE; + } + } // Handle alarm page - if ( TRUE == doesAlarmStatusIndicateStop() ) + else if ( TRUE == doesAlarmStatusIndicateStop() ) { transitionToTreatmentPaused(); result = TREATMENT_PAUSED_STATE; @@ -678,10 +924,39 @@ if ( TRUE == getBloodIsPrimed() ) { lastTreatmentTimeStamp = getMSTimerCount(); - transitionToDialysis(); - result = TREATMENT_DIALYSIS_STATE; + + switch ( treatmentStateBeforePause ) + { + case TREATMENT_ISO_UF_STATE: + transitionToIsolatedUF(); + result = TREATMENT_ISO_UF_STATE; + break; + + case TREATMENT_DIALYSIS_STATE: + transitionToDialysis(); + result = TREATMENT_DIALYSIS_STATE; + break; + + case TREATMENT_BLOOD_PRIME_STATE: + if ( TREATMENT_MODALITY_ISOLATED_UF == getTreatmentParameterU32( TREATMENT_PARAM_TREATMENT_MODALITY ) ) + { + transitionToIsolatedUF(); + result = TREATMENT_ISO_UF_STATE; + } + else + { + transitionToDialysis(); + result = TREATMENT_DIALYSIS_STATE; + } + break; + + default: + SET_ALARM_WITH_2_U32_DATA( ALARM_ID_TD_SOFTWARE_FAULT, SW_FAULT_ID_MODE_TREATMENT_INVALID_STATE, (U32)treatmentStateBeforePause ); + result = TREATMENT_PAUSED_STATE; + break; + } } - else + else { transitionToBloodPrime(); result = TREATMENT_BLOOD_PRIME_STATE; @@ -823,6 +1098,20 @@ { TREATMENT_STATE_T result = TREATMENT_END_STATE; + if ( TRUE == isolatedUFStartRequested ) + { + isolatedUFStartRequested = FALSE; + transitionToIsolatedUF(); + result = TREATMENT_ISO_UF_STATE; + } +// else if ( TRUE == endTreatmentRequest ) +// { +// endTreatmentRequest = FALSE; +// cmdBypassDialyzer( TRUE ); +// cmdChangeQuf( 0.0F ); +// requestNewOperationMode( MODE_POST ); +// } + // // Handle final rinseback alarm response from user // if ( TRUE == initiateRinsebackAlarmResponseRequest ) // { @@ -910,7 +1199,7 @@ payload.treatmentSubMode = (U32)currentTreatmentState; payload.bldPrimeState = getCurrentBloodPrimeState(); payload.dialysisState = getDialysisState(); - payload.isoUFState = 0; + payload.isoUFState = getCurrentIsolatedUFState(); payload.txPausedState = getCurrentTreatmentPausedState(); payload.rinsebackState = 0; // getCurrentRinsebackState(); payload.txRecircState = 0; // getCurrentTreatmentRecircState(); @@ -935,7 +1224,7 @@ { if ( ++treatmentParamsRangesBroadcastTimerCtr >= getU32OverrideValue( &treatmentParamRangesPublishInterval ) ) { - TREATMENT_PARAM_RANGE_BROADCAST_PAYLOAD_T payload; + TREATMENT_PARAM_BROADCAST_PAYLOAD_T payload; // Compute minimum treatment duration U32 presTime = ( presTreatmentTimeSecs / SEC_PER_MIN ); U32 elapseTime = CALC_ELAPSED_TREAT_TIME_IN_MIN(); @@ -969,7 +1258,7 @@ payload.maxUFVolume = maxUFVol; payload.minDialRate = minDialRate; payload.maxDialRate = maxDialRate; - sendMessage( MSG_ID_TD_TREATMENT_PARAM_RANGES, COMM_BUFFER_OUT_CAN_TD_2_UI, (U08*)(&payload), sizeof( TREATMENT_PARAM_RANGE_BROADCAST_PAYLOAD_T ) ); + sendMessage( MSG_ID_TD_TREATMENT_PARAM_RANGES, COMM_BUFFER_OUT_CAN_TD_2_UI, (U08*)(&payload), sizeof( TREATMENT_PARAM_BROADCAST_PAYLOAD_T ) ); } } @@ -1151,7 +1440,40 @@ } } +/*********************************************************************//** + * @brief + * The publishIsolatedUFData function publishes isolated ultrafiltration data + * at the set time interval while isolated UF is active. + * @details \b Inputs: currentTreatmentState, treatmentTimeMS + * @details \b Outputs: none + * @return none + *************************************************************************/ +static void publishIsolatedUFData( void ) +{ + if ( TREATMENT_ISO_UF_STATE == currentTreatmentState ) + { + if ( ++isolatedUFBroadcastTimerCtr >= ULTRAFILTRATION_DATA_PUB_INTERVAL ) + { + ISOLATED_UF_DATA_PAYLOAD_T data; + U32 durationInMinutes = getIsolatedUFDurationMin(); + F32 volumeGoalMl = getIsolatedUFSetVolumeMl(); + data.mDuration = durationInMinutes; + data.mSetVolume = (U32)volumeGoalMl; + data.mVolumeDelivered = (U32)( getIsolatedUFVolumeDrawn() * (F32)ML_PER_LITER ); + data.mRate = (U32)getIsolatedUFRateMlMin(); + + sendMessage( MSG_ID_TD_ISOLATED_UF_DATA, COMM_BUFFER_OUT_CAN_TD_BROADCAST, (U08*)(&data), sizeof( ISOLATED_UF_DATA_PAYLOAD_T ) ); + isolatedUFBroadcastTimerCtr = 0; + } + } + else + { + isolatedUFBroadcastTimerCtr = ULTRAFILTRATION_DATA_PUB_INTERVAL; + } +} + + /************************************************************************* * TEST SUPPORT FUNCTIONS *************************************************************************/