Adjust GPS altitude with geoid