#[derive(Debug, Clone)]
struct AtmosphereLayer {
base_altitude: f64,
base_temperature: f64,
base_pressure: f64,
lapse_rate: f64,
}
const G_ACCEL_MPS2: f64 = 9.80665;
const R_AIR: f64 = 287.0531; const GAMMA: f64 = 1.4;
const R: f64 = 8.314472; const M_A: f64 = 28.96546e-3; const M_V: f64 = 18.01528e-3;
const ICAO_LAYERS: &[AtmosphereLayer] = &[
AtmosphereLayer {
base_altitude: 0.0,
base_temperature: 288.15, base_pressure: 101325.0, lapse_rate: -0.0065, },
AtmosphereLayer {
base_altitude: 11000.0,
base_temperature: 216.65, base_pressure: 22632.1, lapse_rate: 0.0, },
AtmosphereLayer {
base_altitude: 20000.0,
base_temperature: 216.65, base_pressure: 5474.89, lapse_rate: 0.001, },
AtmosphereLayer {
base_altitude: 32000.0,
base_temperature: 228.65, base_pressure: 868.02, lapse_rate: 0.0028, },
AtmosphereLayer {
base_altitude: 47000.0,
base_temperature: 270.65, base_pressure: 110.91, lapse_rate: 0.0, },
AtmosphereLayer {
base_altitude: 51000.0,
base_temperature: 270.65, base_pressure: 66.94, lapse_rate: -0.0028, },
AtmosphereLayer {
base_altitude: 71000.0,
base_temperature: 214.65, base_pressure: 3.96, lapse_rate: -0.002, },
];
fn calculate_icao_standard_atmosphere(altitude_m: f64) -> (f64, f64) {
let altitude = altitude_m.clamp(0.0, 84000.0);
let layer = ICAO_LAYERS
.iter()
.rev()
.find(|layer| altitude >= layer.base_altitude)
.unwrap_or(&ICAO_LAYERS[0]);
let height_diff = altitude - layer.base_altitude;
let temperature = layer.base_temperature + layer.lapse_rate * height_diff;
let pressure = if layer.lapse_rate.abs() < 1e-10 {
layer.base_pressure * (-G_ACCEL_MPS2 * height_diff / (R_AIR * layer.base_temperature)).exp()
} else {
let temp_ratio = temperature / layer.base_temperature;
layer.base_pressure * temp_ratio.powf(-G_ACCEL_MPS2 / (layer.lapse_rate * R_AIR))
};
(temperature, pressure)
}
pub fn resolve_station_pressure(pressure_hpa: f64, altitude_m: f64) -> Option<f64> {
const SEA_LEVEL_HPA: f64 = 1013.25;
if (pressure_hpa - SEA_LEVEL_HPA).abs() < 0.5 && altitude_m.abs() > 1.0 {
None } else {
Some(pressure_hpa) }
}
pub fn resolve_station_temperature(temperature_c: f64, altitude_m: f64) -> Option<f64> {
const SEA_LEVEL_TEMP_C: f64 = 15.0;
if (temperature_c - SEA_LEVEL_TEMP_C).abs() < 0.1 && altitude_m.abs() > 1.0 {
None } else {
Some(temperature_c) }
}
pub fn resolve_station_conditions(
temperature_c: f64,
pressure_hpa: f64,
altitude_m: f64,
) -> (f64, f64) {
let temp_override = resolve_station_temperature(temperature_c, altitude_m);
let press_override = resolve_station_pressure(pressure_hpa, altitude_m);
let (std_temp_k, std_pressure_pa) = calculate_icao_standard_atmosphere(altitude_m);
let temp_c = temp_override.unwrap_or(std_temp_k - 273.15);
let pressure_hpa = press_override.unwrap_or(std_pressure_pa / 100.0);
(temp_c, pressure_hpa)
}
pub fn calculate_atmosphere(
altitude_m: f64,
temp_override_c: Option<f64>,
press_override_hpa: Option<f64>,
humidity_percent: f64,
) -> (f64, f64) {
let (temp_k, pressure_pa) = if temp_override_c.is_some() && press_override_hpa.is_some() {
(
temp_override_c.unwrap() + 273.15,
press_override_hpa.unwrap() * 100.0,
)
} else {
let (std_temp_k, std_pressure_pa) = calculate_icao_standard_atmosphere(altitude_m);
let final_temp_k = if let Some(temp_c) = temp_override_c {
temp_c + 273.15
} else {
std_temp_k
};
let final_pressure_pa = if let Some(press_hpa) = press_override_hpa {
press_hpa * 100.0
} else {
std_pressure_pa
};
(final_temp_k, final_pressure_pa)
};
let humidity_clamped = humidity_percent.clamp(0.0, 100.0);
let temp_c = temp_k - 273.15;
let density = calculate_air_density_cimp(temp_c, pressure_pa / 100.0, humidity_clamped);
let speed_of_sound = moist_speed_of_sound(temp_k, pressure_pa, humidity_clamped);
(density, speed_of_sound)
}
pub fn moist_speed_of_sound(temp_k: f64, pressure_pa: f64, humidity_percent: f64) -> f64 {
let humidity_clamped = humidity_percent.clamp(0.0, 100.0);
let temp_c = temp_k - 273.15;
let p_sv_hpa = enhanced_saturation_vapor_pressure(temp_k);
let f = enhanced_enhancement_factor(pressure_pa, temp_c);
let vapor_pressure_pa = humidity_clamped / 100.0 * f * p_sv_hpa * 100.0;
let mole_fraction_vapor = (vapor_pressure_pa / pressure_pa.max(f64::MIN_POSITIVE)).min(1.0);
let gamma_moist = GAMMA * (1.0 - mole_fraction_vapor * 0.062);
let r_moist = R_AIR * (1.0 + 0.378 * mole_fraction_vapor);
(gamma_moist * r_moist * temp_k).sqrt()
}
pub fn calculate_air_density_cimp(temp_c: f64, pressure_hpa: f64, humidity_percent: f64) -> f64 {
let t_k = temp_c + 273.15;
let p_sv = enhanced_saturation_vapor_pressure(t_k);
let pressure_pa = pressure_hpa * 100.0;
let f = enhanced_enhancement_factor(pressure_pa, temp_c);
let p_v = humidity_percent.clamp(0.0, 100.0) / 100.0 * f * p_sv;
let p_v_pa = p_v * 100.0;
let p_pa = pressure_pa.max(f64::MIN_POSITIVE);
let x_v = (p_v_pa / p_pa).min(1.0);
let z = enhanced_compressibility_factor(p_pa, t_k, x_v);
((p_pa * M_A) / (z * R * t_k)) * (1.0 - x_v * (1.0 - M_V / M_A))
}
#[inline(always)]
fn enhanced_saturation_vapor_pressure(t_k: f64) -> f64 {
const A: [f64; 6] = [
-7.85951783,
1.84408259,
-11.7866497,
22.6807411,
-15.9618719,
1.80122502,
];
let t_k_safe = t_k.max(173.15);
let tau = 1.0 - t_k_safe / 647.096; let ln_p_ratio = (647.096 / t_k_safe)
* (A[0] * tau
+ A[1] * tau.powf(1.5)
+ A[2] * tau.powf(3.0)
+ A[3] * tau.powf(3.5)
+ A[4] * tau.powf(4.0)
+ A[5] * tau.powf(7.5));
220640.0 * ln_p_ratio.exp() }
#[inline(always)]
fn enhanced_enhancement_factor(p: f64, t: f64) -> f64 {
const ALPHA: f64 = 1.00062;
const BETA: f64 = 3.14e-8;
const GAMMA: f64 = 5.6e-7;
ALPHA + BETA * p + GAMMA * t * t
}
#[inline(always)]
fn enhanced_compressibility_factor(p: f64, t_k: f64, x_v: f64) -> f64 {
const A0: f64 = 1.58123e-6;
const A1: f64 = -2.9331e-8;
const A2: f64 = 1.1043e-10;
const B0: f64 = 5.707e-6;
const B1: f64 = -2.051e-8;
const C0: f64 = 1.9898e-4;
const C1: f64 = -2.376e-6;
const D: f64 = 1.83e-11;
const E: f64 = -0.765e-8;
let t_k_safe = t_k.max(173.15); let t = t_k_safe - 273.15;
let p_t = p / t_k_safe;
let z_second_order =
1.0 - p_t * (A0 + A1 * t + A2 * t * t + (B0 + B1 * t) * x_v + (C0 + C1 * t) * x_v * x_v);
let z_third_order = p_t * p_t * (D + E * x_v * x_v);
z_second_order + z_third_order
}
pub fn get_local_atmosphere(
altitude_m: f64,
base_alt: f64,
base_temp_c: f64,
base_press_hpa: f64,
base_ratio: f64,
) -> (f64, f64) {
let (temp_k, _pressure_pa, density) =
local_temp_pressure_density(altitude_m, base_alt, base_temp_c, base_press_hpa, base_ratio);
let speed_of_sound = (temp_k * 401.874).sqrt();
(density, speed_of_sound)
}
pub fn get_local_atmosphere_humid(
altitude_m: f64,
base_alt: f64,
base_temp_c: f64,
base_press_hpa: f64,
base_ratio: f64,
humidity_percent: f64,
) -> (f64, f64) {
let (temp_k, pressure_pa, density) =
local_temp_pressure_density(altitude_m, base_alt, base_temp_c, base_press_hpa, base_ratio);
(density, moist_speed_of_sound(temp_k, pressure_pa, humidity_percent))
}
#[inline]
fn local_temp_pressure_density(
altitude_m: f64,
base_alt: f64,
base_temp_c: f64,
base_press_hpa: f64,
base_ratio: f64,
) -> (f64, f64, f64) {
let altitude_m_rounded = altitude_m.round();
let height_diff = altitude_m_rounded - base_alt;
let lapse_rate = determine_local_lapse_rate(altitude_m_rounded);
let temp_c = base_temp_c + lapse_rate * height_diff;
let temp_k = temp_c + 273.15;
let base_temp_k = base_temp_c + 273.15;
let pressure_hpa = if lapse_rate.abs() < 1e-10 {
base_press_hpa * (-G_ACCEL_MPS2 * height_diff / (R_AIR * base_temp_k)).exp()
} else {
let temp_ratio = temp_k / base_temp_k;
base_press_hpa * temp_ratio.powf(-G_ACCEL_MPS2 / (lapse_rate * R_AIR))
};
let density_ratio = base_ratio * (base_temp_k * pressure_hpa) / (base_press_hpa * temp_k);
let density = density_ratio * 1.225;
(temp_k, pressure_hpa * 100.0, density)
}
#[inline(always)]
fn determine_local_lapse_rate(altitude_m: f64) -> f64 {
let layer = ICAO_LAYERS
.iter()
.rev()
.find(|layer| altitude_m >= layer.base_altitude)
.unwrap_or(&ICAO_LAYERS[0]);
layer.lapse_rate
}
#[inline(always)]
pub fn get_direct_atmosphere(density: f64, speed_of_sound: f64) -> (f64, f64) {
(density, speed_of_sound)
}
pub fn calculate_air_density_cipm(temp_c: f64, pressure_hpa: f64, humidity_percent: f64) -> f64 {
calculate_air_density_cimp(temp_c, pressure_hpa, humidity_percent)
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_mba1136_dry_sea_level_reference() {
let (density, sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
assert!(
(density - 1.225).abs() < 0.002,
"dry sea-level density {density} not within 1.225 +- 0.002"
);
assert!(
(sos - 340.3).abs() < 0.6,
"dry sea-level speed of sound {sos} not within 340.3 +- 0.6"
);
}
#[test]
fn test_mba1136_humid_lighter_than_dry() {
let (dry_rho, dry_sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
let (moist_rho, moist_sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 50.0);
assert!(
(moist_rho - 1.2211).abs() < 0.002,
"50% RH density {moist_rho} not within CIPM 1.2211 +- 0.002"
);
assert!(
moist_rho < dry_rho,
"moist air ({moist_rho}) must be lighter than dry ({dry_rho})"
);
assert!(
moist_sos > dry_sos,
"moist speed of sound ({moist_sos}) must exceed dry ({dry_sos})"
);
}
#[test]
fn test_mba1136_density_monotone_in_humidity() {
let (rho_0, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
let (rho_50, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 50.0);
let (rho_100, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 100.0);
assert!(
rho_100 < rho_50 && rho_50 < rho_0,
"humidity monotonicity violated: 100%={rho_100}, 50%={rho_50}, 0%={rho_0}"
);
}
#[test]
fn test_mba1136_atmosphere_density_is_cipm() {
for (t, p, h) in [
(15.0, 1013.25, 0.0),
(15.0, 1013.25, 50.0),
(30.0, 1000.0, 80.0),
(-10.0, 1020.0, 20.0),
] {
let (density, _) = calculate_atmosphere(0.0, Some(t), Some(p), h);
let cipm = calculate_air_density_cimp(t, p, h);
assert_eq!(
density, cipm,
"calculate_atmosphere density must equal CIPM at {t}C/{p}hPa/{h}%"
);
}
}
#[test]
fn test_mba1136_moist_speed_of_sound_extraction() {
for (t, p, h) in [
(15.0, 1013.25, 0.0),
(15.0, 1013.25, 50.0),
(25.0, 900.0, 100.0),
] {
let (_, sos) = calculate_atmosphere(0.0, Some(t), Some(p), h);
let extracted = moist_speed_of_sound(t + 273.15, p * 100.0, h);
assert_eq!(
sos, extracted,
"extracted moist_speed_of_sound must match calculate_atmosphere at {t}C/{p}hPa/{h}%"
);
}
}
#[test]
fn test_mba1136_get_local_atmosphere_unchanged() {
let (d0, c0) = get_local_atmosphere(500.0, 500.0, 10.0, 950.0, 1.05);
assert!((d0 - 1.286250000000).abs() < 1e-9, "local density@500m drifted: {d0}");
assert!((c0 - 337.328657395129).abs() < 1e-9, "local sos@500m drifted: {c0}");
let (d1, c1) = get_local_atmosphere(1500.0, 500.0, 10.0, 950.0, 1.05);
assert!((d1 - 1.165201643681).abs() < 1e-9, "local density@1500m drifted: {d1}");
assert!((c1 - 333.434314520866).abs() < 1e-9, "local sos@1500m drifted: {c1}");
}
#[test]
fn test_mba1136_get_local_atmosphere_humid() {
let (d_dry, c_dry) = get_local_atmosphere(1500.0, 500.0, 10.0, 950.0, 1.05);
let (d_h0, c_h0) = get_local_atmosphere_humid(1500.0, 500.0, 10.0, 950.0, 1.05, 0.0);
assert_eq!(d_dry, d_h0, "humid variant must not change density");
assert!(
(c_h0 - c_dry).abs() < 1e-3,
"0% RH humid sos {c_h0} should match dry sos {c_dry}"
);
let (_, c_h80) = get_local_atmosphere_humid(1500.0, 500.0, 10.0, 950.0, 1.05, 80.0);
assert!(c_h80 > c_dry, "humid sos {c_h80} should exceed dry {c_dry}");
}
#[test]
fn test_icao_standard_atmosphere() {
let (temp, press) = calculate_icao_standard_atmosphere(0.0);
assert!((temp - 288.15).abs() < 0.01);
assert!((press - 101325.0).abs() < 1.0);
let (temp_11km, press_11km) = calculate_icao_standard_atmosphere(11000.0);
assert!((temp_11km - 216.65).abs() < 0.01);
assert!(press_11km < 101325.0);
let (temp_25km, _) = calculate_icao_standard_atmosphere(25000.0);
assert!(temp_25km > 216.65); }
#[test]
fn test_enhanced_atmosphere_sea_level() {
let (density, speed) = calculate_atmosphere(0.0, None, None, 0.0);
assert!((density - 1.225).abs() < 0.01);
assert!((speed - 340.0).abs() < 1.0);
}
#[test]
fn test_resolve_station_pressure_contract() {
assert_eq!(resolve_station_pressure(1013.25, 2000.0), None);
assert_eq!(resolve_station_pressure(1013.21, 2000.0), None);
assert_eq!(resolve_station_pressure(850.0, 2000.0), Some(850.0));
assert_eq!(resolve_station_pressure(1013.25, 0.0), Some(1013.25));
}
#[test]
fn test_altitude_affects_density_with_default_pressure() {
let press = resolve_station_pressure(1013.25, 0.0);
let (rho_sea, _) = calculate_atmosphere(0.0, Some(15.0), press, 50.0);
let press_alt = resolve_station_pressure(1013.25, 2000.0);
let (rho_2km, _) = calculate_atmosphere(2000.0, Some(15.0), press_alt, 50.0);
assert!(
rho_2km < rho_sea * 0.9,
"density at 2000 m ({rho_2km}) should be well below sea level ({rho_sea})"
);
let p = resolve_station_pressure(900.0, 2000.0);
let (rho_a, _) = calculate_atmosphere(2000.0, Some(15.0), p, 50.0);
let (rho_b, _) = calculate_atmosphere(0.0, Some(15.0), p, 50.0);
assert!(
(rho_a - rho_b).abs() < 1e-9,
"explicit pressure must ignore altitude"
);
}
#[test]
fn test_resolve_station_temperature_contract() {
assert_eq!(resolve_station_temperature(15.0, 2000.0), None);
assert_eq!(resolve_station_temperature(-5.0, 2000.0), Some(-5.0));
assert_eq!(resolve_station_temperature(30.0, 2000.0), Some(30.0));
assert_eq!(resolve_station_temperature(15.0, 0.0), Some(15.0));
}
#[test]
fn test_altitude_only_default_matches_full_icao_standard() {
for alt in [1000.0, 2000.0, 2500.0, 3000.0] {
let t = resolve_station_temperature(15.0, alt);
let p = resolve_station_pressure(1013.25, alt);
let (rho_resolved, _) = calculate_atmosphere(alt, t, p, 0.0);
let (rho_std, _) = calculate_atmosphere(alt, None, None, 0.0);
assert!(
(rho_resolved - rho_std).abs() < 1e-9,
"alt {alt}: altitude-only default density {rho_resolved} should equal the full \
ICAO standard {rho_std}"
);
let (rho_warm, _) = calculate_atmosphere(alt, Some(15.0), p, 0.0);
assert!(
rho_resolved > rho_warm,
"alt {alt}: lapse-temperature density {rho_resolved} should exceed 15 C-held {rho_warm}"
);
}
}
#[test]
fn test_enhanced_atmosphere_with_humidity() {
let (density_dry, speed_dry) = calculate_atmosphere(0.0, None, None, 0.0);
let (density_humid, speed_humid) = calculate_atmosphere(0.0, None, None, 80.0);
assert!(density_humid < density_dry);
assert!(speed_humid > speed_dry);
}
#[test]
fn test_enhanced_atmosphere_stratosphere() {
let (density_20km, speed_20km) = calculate_atmosphere(20000.0, None, None, 0.0);
let (density_30km, speed_30km) = calculate_atmosphere(30000.0, None, None, 0.0);
assert!(density_30km < density_20km);
assert!(speed_30km > speed_20km);
}
#[test]
fn test_enhanced_cimp_density() {
let density = calculate_air_density_cimp(15.0, 1013.25, 0.0);
assert!((density - 1.225).abs() < 0.01);
let density_humid = calculate_air_density_cimp(15.0, 1013.25, 50.0);
assert!(density_humid < density);
}
#[test]
fn test_cipm_moist_air_matches_python_reference() {
let cases = [
(15.0, 1013.25, 50.0, 1.221125867723075),
(30.0, 1000.0, 80.0, 1.1344071877123691),
(-10.0, 1020.0, 20.0, 1.3500610713710515),
];
for (temp_c, pressure_hpa, humidity_pct, expected) in cases {
let density = calculate_air_density_cipm(temp_c, pressure_hpa, humidity_pct);
let rel_err = ((density - expected) / expected).abs();
assert!(
rel_err < 1e-3,
"CIPM density at {temp_c} C / {pressure_hpa} hPa / {humidity_pct}% RH: \
got {density}, expected {expected} (rel err {rel_err:.2e} >= 1e-3)"
);
}
let dry = calculate_air_density_cipm(15.0, 1013.25, 0.0);
let moist = calculate_air_density_cipm(15.0, 1013.25, 50.0);
assert!(
dry - moist > 3e-3,
"humidity effect too small: dry {dry} vs 50% RH {moist}"
);
}
#[test]
fn test_variable_lapse_rates() {
let lapse_tropo = determine_local_lapse_rate(5000.0);
let lapse_strato = determine_local_lapse_rate(25000.0);
assert!((lapse_tropo - (-0.0065)).abs() < 0.0001);
assert!(lapse_strato > 0.0); }
}