Restore GPS altitude in position message, instead of rangefinder altitude