Base implementation for FSM
Working state switching
FSM finished
BehavioralTree added
Project cleanup
HTN finished