Did all modifications for displaying multiple waypoints, untested.