Altitude correction in altitude mode