Moved step(), goToState(), and getRobotController() from SoldierSM to StateMachine. This was done in hariharPlayer