/**************************************************************************
 *
 *  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 ModeFault.c
 *
 *  @date 19-Sep-2019
 *  @author S. Nash
 *
 *  @brief Top-level state machine for the fault mode.
 *
 **************************************************************************/

#include "AlarmLamp.h"
#ifdef EMC_TEST_BUILD     // TODO - test code
#include "BloodFlow.h"
#include "Buttons.h"
#include "DialInFlow.h"
#include "DialOutFlow.h"
#endif
#include "OperationModes.h"
#include "ModeFault.h"

    /**
     *  @addtogroup HDFaultMode
     *  @{
     */

// ********** private data **********

// ********** private function prototypes **********

/*************************************************************************
 * @brief initFaultMode
 * The initFaultMode function initializes the Fault Mode module.
 * @details
 * Inputs : none
 * Outputs : Fault Mode module initialized.
 * @param none
 * @return none
 *************************************************************************/
void initFaultMode( void )
{
}

/*************************************************************************
 * @brief transitionToFaultMode
 * The transitionToFaultMode function prepares for transition to fault mode.
 * @details
 * Inputs : none
 * Outputs :
 * @param none
 * @return none
 *************************************************************************/
void transitionToFaultMode( void )
{
}

/*************************************************************************
 * @brief execFaultMode
 * The execFaultMode function executes the Fault Mode state machine.
 * @details
 * Inputs : none
 * Outputs :
 * @param none
 * @return current state (sub-mode)
 *************************************************************************/
U32 execFaultMode( void )
{
#ifdef EMC_TEST_BUILD     // TODO - test code
    static BOOL toggle = FALSE;
    static BOOL button_state = FALSE;
    BOOL stop = isStopButtonPressed();

    if ( TRUE == stop )
    {
        if ( stop != button_state )
        {
            toggle = ( toggle == TRUE ? FALSE : TRUE );
            if ( TRUE == 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 );
            }
            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 );
            }
        }
    }
    button_state = stop;
#endif

    return 0; // TODO - return current state
}

/**@}*/