/**************************************************************************
*
* 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 ModeInitPOST.c
*
* @author (last) Sean Nash
* @date (last) 14-Oct-2020
*
* @author (original) Dara Navaei
* @date (original) 05-Nov-2019
*
***************************************************************************/

#include "Accel.h"
#include "AlarmLamp.h"
#include "BloodFlow.h"
#include "Buttons.h"
#include "CPLD.h"
#include "DialInFlow.h"
#include "FPGA.h"
#include "OperationModes.h"
#include "RTC.h"
#include "WatchdogMgmt.h"
#include "ModeInitPOST.h"
#include "NVDataMgmt.h"
#include "Valves.h"

    /**
     *  @addtogroup HDInitAndPOSTMode
     *  @{
     */

// ********** private definitions **********

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

static HD_POST_STATE_T postState = POST_STATE_START;        ///< Current state of initialize and POST mode.
static BOOL postCompleted = FALSE;                          ///< Flag indicates whether POST is completed.
static BOOL postPassed = FALSE;                             ///< Flag indicates all POST tests passed.
static BOOL tempPOSTPassed = TRUE;                          ///< Flag indicates all POST tests have passed so far.

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

static HD_POST_STATE_T handlePOSTStatus( SELF_TEST_STATUS_T testStatus );

/*********************************************************************//**
 * @brief
 * The initInitAndPOSTMode function initializes the Initialize & POST Mode module.
 * @details Inputs: none
 * @details Outputs: Initialize & POST Mode module initialized.
 * @return none
 *************************************************************************/
void initInitAndPOSTMode( void )
{
    postState = POST_STATE_START;
    postCompleted = FALSE;
    postPassed = FALSE;
    tempPOSTPassed = TRUE;
}

/*********************************************************************//**
 * @brief
 * The transitionToInitAndPOSTMode function prepares for transition to
 * initialize & POST mode.
 * @details Inputs: none
 * @details Outputs: none
 * @return none
 *************************************************************************/
void transitionToInitAndPOSTMode( void )
{
}

/*********************************************************************//**
 * @brief
 * The execInitAndPOSTMode function executes the Initialize & POST Mode state machine.
 * @details Inputs: postState
 * @details Outputs: postState, postPassed, postCompleted
 * @return current state (sub-mode)
 *************************************************************************/
U32 execInitAndPOSTMode( void )
{
    SELF_TEST_STATUS_T testStatus = SELF_TEST_STATUS_IN_PROGRESS;

    // TODO - send POST status on CAN

    // execute current POST state     *Note - these switch cases must be in same order as enum HD_POST_States
    switch ( postState )
    {
        case POST_STATE_START:
            postState = POST_STATE_WATCHDOG;
#ifdef RM46_EVAL_BOARD_TARGET
            postState = POST_STATE_COMPLETED;
#endif
#ifdef SKIP_POST
#ifndef DISABLE_UI_TREATMENT_WORKFLOW
            postState = POST_STATE_VALVES;
#else
            postState = POST_STATE_COMPLETED;
            postState = POST_STATE_VALVES;
#endif
#endif
            break;

        case POST_STATE_WATCHDOG:
            testStatus = execWatchdogTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_ALARM_LAMP:
            testStatus = execAlarmLampTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_FPGA:
            testStatus = execFPGATest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_RTC:
            testStatus = execRTCSelfTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_NVDATAMGMT:
            testStatus = execNVDataMgmtSelfTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_BLOOD_FLOW:
            testStatus = execBloodFlowTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_DIALYSATE_FLOW:
            testStatus = execDialInFlowTest();
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_ACCELEROMETER:
#ifndef DISABLE_ACCELS
            testStatus = execAccelTest();
#else
            testStatus = SELF_TEST_STATUS_PASSED;
#endif
            postState = handlePOSTStatus( testStatus );
            break;

        case POST_STATE_VALVES:
            testStatus = execValvesSelfTest();
            postState = POST_STATE_STUCK_BUTTON;
            break;

        // Should be last POST
        case POST_STATE_STUCK_BUTTON:
            testStatus = execStuckButtonTest();
            handlePOSTStatus( testStatus );  // ignoring return value because last test

            if ( TRUE == tempPOSTPassed )
            {
                postState = POST_STATE_COMPLETED;
            }
            else
            {
                postState = POST_STATE_FAILED;
            }
            break;

        case POST_STATE_COMPLETED:
            // set overall HD POST status to "passed"
            postPassed = TRUE;
            // set overall HD POST completed status to TRUE
            postCompleted = TRUE;
            // TODO - send POST status on CAN
            // go to standby mode
            requestNewOperationMode( MODE_STAN );
            break;

        case POST_STATE_FAILED:
            // should not get here - any failed post test should have already triggered a fault and taken us to fault mode
        default:
            SET_ALARM_WITH_2_U32_DATA( ALARM_ID_HD_SOFTWARE_FAULT, SW_FAULT_ID_MODE_INIT_POST_INVALID_POST_STATE, postState )
            postState = POST_STATE_FAILED;
            break;
    }

    return postState;
}

/*********************************************************************//**
 * @brief
 * The isPOSTCompleted function determines whether all HD POST have
 * been run and completed.  If true, call the isPOSTPassed() to see final
 * result (pass/fail).
 * @details Inputs: postCompleted
 * @details Outputs: none
 * @return true if all HD POST tests have completed, false if not
 *************************************************************************/
BOOL isPOSTCompleted( void )
{
    return postCompleted;
}

/*********************************************************************//**
 * @brief
 * The isPOSTPassed function determines whether all HD POST have passed.
 * Call this function after POST is complete (call isPOSTCompleted function).
 * @details Inputs: postPassed
 * @details Outputs: none
 * @return true if all HD POST tests have passed, false if not
 *************************************************************************/
BOOL isPOSTPassed( void )
{
    return postPassed;
}

/*********************************************************************//**
 * @brief
 * The handlePOSTStatus function handles a status result returned by a
 * POST function.
 * @details Inputs: postPassed
 * @details Outputs: none
 * @param testStatus status reported by last test
 * @return recommended next POST state
 *************************************************************************/
static HD_POST_STATE_T handlePOSTStatus( SELF_TEST_STATUS_T testStatus )
{
    HD_POST_STATE_T result = postState;

    if ( testStatus == SELF_TEST_STATUS_PASSED )
    {
        result = (HD_POST_STATE_T)((int)postState + 1);  // move on to next POST test
    }
    else if ( testStatus == SELF_TEST_STATUS_FAILED )
    {
        requestAlarmLampPattern( LAMP_PATTERN_FAULT );
        tempPOSTPassed = FALSE;
        result = POST_STATE_FAILED;
    }
    else
    {
        // test still in progress - do nothing
    }

    return result;
}