fixed loading in current and next waypoints, added new debug messages
for nav, groundTrackHeading is now working