Use waypoints directly for realtime path