Basic movement based FSM working