Adds waypoints, thanks slippy