Create StateMachine_test.cpp