AP_Airspeed: Altitude Calibration - added constrain on P matrix diagonals
AP_Baro: extend the atmospheric model to higher altitudes