reviewed moveToWaypoint.