Index: firmware/App/Modes/ModeStandby.c =================================================================== diff -u -r8a18b5d1fb4598c6b7facb3e7e233252941eaded -r8e7158d8231435496fcf1d5649e51babf859ccc7 --- firmware/App/Modes/ModeStandby.c (.../ModeStandby.c) (revision 8a18b5d1fb4598c6b7facb3e7e233252941eaded) +++ firmware/App/Modes/ModeStandby.c (.../ModeStandby.c) (revision 8e7158d8231435496fcf1d5649e51babf859ccc7) @@ -1,19 +1,21 @@ /************************************************************************** - * - * 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 ModeStandby.c - * - * @date 19-Sep-2019 - * @author S. Nash - * - * @brief Top-level state machine for the standby mode. - * - **************************************************************************/ +* +* Copyright (c) 2019-2021 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 ModeStandby.c +* +* @author (last) Sean Nash +* @date (last) 13-Nov-2020 +* +* @author (original) Dara Navaei +* @date (original) 05-Nov-2019 +* +***************************************************************************/ +#include "AirTrap.h" #include "AlarmLamp.h" #include "BloodFlow.h" #include "Buttons.h" @@ -25,93 +27,94 @@ #include "SystemComm.h" #include "SystemCommMessages.h" #include "ModeStandby.h" +#ifdef EMC_TEST_BUILD // TODO - test code +#include "FPGA.h" +#endif #ifdef RM46_EVAL_BOARD_TARGET #include "Timers.h" static U32 start; #endif - /** - * @addtogroup HDStandbyMode - * @{ - */ +/** + * @addtogroup HDStandbyMode + * @{ + */ - // ********** private definitions ********** +// ********** private definitions ********** // ********** private data ********** -static HD_STANDBY_STATE_T currentStandbyState; ///< Current state (sub-mode) of standby mode. +static HD_STANDBY_STATE_T currentStandbyState; ///< Current state (sub-mode) of standby mode. +static BOOL treatStartReqReceived = FALSE; ///< Flag indicates user has requested initiation of a treatment + // ********** private function prototypes ********** -/************************************************************************* - * @brief initStandbyMode +/*********************************************************************//** + * @brief * The initStandbyMode function initializes the Standby Mode module. - * @details - * Inputs : none - * Outputs : Standby Mode module initialized. - * @param none + * @details Inputs: none + * @details Outputs: Standby Mode module initialized. * @return none *************************************************************************/ void initStandbyMode( void ) { currentStandbyState = STANDBY_START_STATE; + treatStartReqReceived = FALSE; } -/************************************************************************* - * @brief transitionToStandbyMode +/*********************************************************************//** + * @brief * The transitionToStandbyMode function prepares for transition to standby mode. - * @details - * Inputs : none - * Outputs : - * @param none + * @details Inputs: none + * @details Outputs: Standby Mode module re-initialized, DG interface initialized, + * blood & dialysate pumps shut off. * @return none *************************************************************************/ void transitionToStandbyMode( void ) { // re-initialize when transitioning to standby mode initStandbyMode(); initDGInterface(); + resetAirTrap(); -#ifndef UF_TEST_ENABLED + // pumps should be off setBloodPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_CLOSED_LOOP ); setDialInPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_CLOSED_LOOP ); - setDialOutPumpTargetRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); -#endif + setDialOutPumpTargetRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_CLOSED_LOOP ); #ifdef RM46_EVAL_BOARD_TARGET start = getMSTimerCount(); #endif } -/************************************************************************* - * @brief execStandbyMode +/*********************************************************************//** + * @brief * The execStandbyMode function executes the Standby Mode state machine. - * @details - * Inputs : none - * Outputs : - * @param none + * @details Inputs: currentStandbyState + * @details Outputs: currentStandbyState * @return current state (sub-mode) *************************************************************************/ U32 execStandbyMode( void ) { #ifdef EMC_TEST_BUILD - static BOOL toggle = FALSE; + static U32 toggle = 0; static BOOL button_state = FALSE; #endif -BOOL stop = isStopButtonPressed(); + BOOL stop = isStopButtonPressed(); DG_OP_MODE_T dgOpMode = getDGOpMode(); // TODO - the DG mode & sub-mode come as a pair at interval - they MUST be kept together. U32 dgSubMode = getDGSubMode(); -#ifdef UF_TEST_WITH_DG +#ifndef RUN_WITHOUT_DG // state machine to get DG to prep a reservoir so we can start a treatment switch ( currentStandbyState ) { case STANDBY_START_STATE: // temporary test code - TODO - remove later if ( TRUE == isDGCommunicating() ) { - //homeBloodPump(); - //homeDialInPump(); - //homeDialOutPump(); + homeBloodPump(); + homeDialInPump(); + homeDialOutPump(); cmdSetDGDialysateTargetTemps( 39.0, 37.0 ); cmdSetDGActiveReservoir( DG_RESERVOIR_2 ); cmdStartDG(); @@ -172,15 +175,27 @@ case STANDBY_WAIT_FOR_TREATMENT_STATE: // TODO - test code +#ifdef DISABLE_UI_TREATMENT_WORKFLOW if ( TRUE == stop ) +#endif { if ( DG_MODE_CIRC == dgOpMode ) { if ( DG_RECIRCULATE_MODE_STATE_RECIRC_WATER == dgSubMode ) { +#ifndef DISABLE_UI_TREATMENT_WORKFLOW + if ( TRUE == treatStartReqReceived ) + { + setStartReservoirVolume(); + cmdSetDGActiveReservoir( DG_RESERVOIR_1 ); + requestNewOperationMode( MODE_TPAR ); + treatStartReqReceived = FALSE; + } +#else setStartReservoirVolume(); cmdSetDGActiveReservoir( DG_RESERVOIR_1 ); requestNewOperationMode( MODE_TPAR ); +#endif } } } @@ -196,36 +211,75 @@ switch ( currentStandbyState ) { case STANDBY_START_STATE: + currentStandbyState = STANDBY_WAIT_FOR_TREATMENT_STATE; // temporary test code - TODO - remove later homeBloodPump(); homeDialInPump(); homeDialOutPump(); - currentStandbyState = STANDBY_WAIT_FOR_TREATMENT_STATE; +#ifdef EMC_TEST_BUILD + startAirTrapControl(); +#endif break; case STANDBY_WAIT_FOR_TREATMENT_STATE: + if ( TRUE == treatStartReqReceived ) + { + requestNewOperationMode( MODE_TPAR ); + treatStartReqReceived = FALSE; + } // TODO - test code if ( TRUE == stop ) { + treatStartReqReceived = FALSE; + setValvePosition( VDI, VALVE_POSITION_C_CLOSE ); + setValvePosition( VDO, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBA, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBV, VALVE_POSITION_C_CLOSE ); + requestNewOperationMode( MODE_TPAR ); #ifdef EMC_TEST_BUILD if ( stop != button_state ) { - toggle = ( toggle == TRUE ? FALSE : TRUE ); - if ( TRUE == toggle ) + toggle = INC_WRAP( toggle, 0, 3 ); + switch ( toggle ) { - setBloodPumpTargetFlowRate( 500, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); - setDialInPumpTargetFlowRate( 500, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); - setDialOutPumpTargetRate( 500, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + case 0: // pumps and valves off + setValvePosition( VDI, VALVE_POSITION_C_CLOSE ); + setValvePosition( VDO, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBA, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBV, VALVE_POSITION_C_CLOSE ); + break; + + case 1: // pumps on, valves off + setBloodPumpTargetFlowRate( 200, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialInPumpTargetFlowRate( 500, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialOutPumpTargetRate( 500, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + break; + + case 2: // pumps on, valves on + setValvePosition( VDI, VALVE_POSITION_B_OPEN ); + setValvePosition( VDO, VALVE_POSITION_B_OPEN ); + setValvePosition( VBA, VALVE_POSITION_B_OPEN ); + setValvePosition( VBV, VALVE_POSITION_B_OPEN ); + break; + + case 3: // pumps off, valves on + setBloodPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialInPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialOutPumpTargetRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + break; + + default: // shouldn't get here, reset if we do + toggle = 0; + setBloodPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialInPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setDialOutPumpTargetRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); + setValvePosition( VDI, VALVE_POSITION_C_CLOSE ); + setValvePosition( VDO, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBA, VALVE_POSITION_C_CLOSE ); + setValvePosition( VBV, VALVE_POSITION_C_CLOSE ); + break; } - else - { - setBloodPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); - setDialInPumpTargetFlowRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); - setDialOutPumpTargetRate( 0, MOTOR_DIR_FORWARD, PUMP_CONTROL_MODE_OPEN_LOOP ); - } } -#else - requestNewOperationMode( MODE_TPAR ); #endif } #ifdef EMC_TEST_BUILD @@ -250,4 +304,26 @@ return currentStandbyState; } +/*********************************************************************//** + * @brief + * The signalUserStartingTreatment function handles user initiation of a + * treatment. + * @details Inputs: none + * @details Outputs: requested mode transition to treatment parameters mode + * @return TRUE if signal accepted, FALSE if not + *************************************************************************/ +BOOL signalUserStartingTreatment( void ) +{ + BOOL result = FALSE; + + if ( ( MODE_STAN == getCurrentOperationMode() ) && ( STANDBY_WAIT_FOR_TREATMENT_STATE == currentStandbyState ) ) + { + treatStartReqReceived = TRUE; + result = TRUE; + } + sendTreatmentStartResponseMsg( result, 0 ); // TODO - provide reason code if rejected + + return result; +} + /**@}*/