Console Output

fix multiple waypoints