private void StateFollowPassUpdate() { if (pathHandlerBase.GetPathLength() == 0) { state = State.Wait; } else { MoveForward(pathHandlerBase.getNextPoint()); } }