Fixing waypoint seeking.