StateMachine.cc 1.23 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61
/****************************************************************************
 *
 * (c) 2009-2020 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/

#include "StateMachine.h"

StateMachine::StateMachine(void)
{

}

void StateMachine::start(void)
{
    _active = true;
    advance();
}

void StateMachine::advance(void)
{
    if (_active) {
        _stateIndex++;
        if (_stateIndex < stateCount()) {
            (*rgStates()[_stateIndex])(this);
        } else {
            _active = false;
            statesCompleted();
        }
    }
}

void StateMachine::move(StateFn stateFn)
{
    if (_active) {
        for (int i=0; i<stateCount(); i++) {
            if (rgStates()[i] == stateFn) {
                _stateIndex = i;
                (*rgStates()[_stateIndex])(this);
                break;
            }
        }
    }
}

void StateMachine::statesCompleted(void) const
{

}

StateMachine::StateFn StateMachine::currentState(void)
{
    if (_active) {
        return rgStates()[_stateIndex];
    } else {
        return nullptr;
    }
}