1use std::cmp::Ordering;
7
8#[derive(Debug, Clone)]
10struct AtmosphereLayer {
11 base_altitude: f64,
13 base_temperature: f64,
15 base_pressure: f64,
17 lapse_rate: f64,
19}
20
21const G_ACCEL_MPS2: f64 = 9.80665;
23const R_AIR: f64 = 287.0531; const GAMMA: f64 = 1.4; const GEOPOTENTIAL_EARTH_RADIUS_M: f64 = 6_356_766.0;
26const MIN_GEOMETRIC_ALTITUDE_M: f64 = -5000.0;
27const MAX_GEOMETRIC_ALTITUDE_M: f64 = 84000.0;
28const MIN_STANDARD_GEOPOTENTIAL_HEIGHT_M: f64 = -5000.0;
29const MAX_STANDARD_GEOPOTENTIAL_HEIGHT_M: f64 = 84000.0;
30
31const R: f64 = 8.314472; const M_A: f64 = 28.96546e-3; const M_V: f64 = 18.01528e-3; const ICAO_LAYERS: &[AtmosphereLayer] = &[
39 AtmosphereLayer {
41 base_altitude: 0.0,
42 base_temperature: 288.15, base_pressure: 101325.0, lapse_rate: -0.0065, },
46 AtmosphereLayer {
48 base_altitude: 11000.0,
49 base_temperature: 216.65, base_pressure: 22632.1, lapse_rate: 0.0, },
53 AtmosphereLayer {
55 base_altitude: 20000.0,
56 base_temperature: 216.65, base_pressure: 5474.89, lapse_rate: 0.001, },
60 AtmosphereLayer {
62 base_altitude: 32000.0,
63 base_temperature: 228.65, base_pressure: 868.02, lapse_rate: 0.0028, },
67 AtmosphereLayer {
69 base_altitude: 47000.0,
70 base_temperature: 270.65, base_pressure: 110.91, lapse_rate: 0.0, },
74 AtmosphereLayer {
76 base_altitude: 51000.0,
77 base_temperature: 270.65, base_pressure: 66.94, lapse_rate: -0.0028, },
81 AtmosphereLayer {
83 base_altitude: 71000.0,
84 base_temperature: 214.65, base_pressure: 3.96, lapse_rate: -0.002, },
88];
89
90fn calculate_icao_standard_atmosphere(altitude_m: f64) -> (f64, f64) {
102 let geometric_altitude = altitude_m.clamp(MIN_GEOMETRIC_ALTITUDE_M, MAX_GEOMETRIC_ALTITUDE_M);
103 let geopotential_height = geometric_to_geopotential_height_m(geometric_altitude).clamp(
104 MIN_STANDARD_GEOPOTENTIAL_HEIGHT_M,
105 MAX_STANDARD_GEOPOTENTIAL_HEIGHT_M,
106 );
107
108 let layer = ICAO_LAYERS
110 .iter()
111 .rev()
112 .find(|layer| geopotential_height >= layer.base_altitude)
113 .unwrap_or(&ICAO_LAYERS[0]);
114
115 let height_diff = geopotential_height - layer.base_altitude;
116 let temperature = layer.base_temperature + layer.lapse_rate * height_diff;
117
118 let pressure = if layer.lapse_rate.abs() < 1e-10 {
119 layer.base_pressure * (-G_ACCEL_MPS2 * height_diff / (R_AIR * layer.base_temperature)).exp()
121 } else {
122 let temp_ratio = temperature / layer.base_temperature;
124 layer.base_pressure * temp_ratio.powf(-G_ACCEL_MPS2 / (layer.lapse_rate * R_AIR))
125 };
126
127 (temperature, pressure)
128}
129
130#[inline]
132fn geometric_to_geopotential_height_m(geometric_altitude_m: f64) -> f64 {
133 GEOPOTENTIAL_EARTH_RADIUS_M * geometric_altitude_m
134 / (GEOPOTENTIAL_EARTH_RADIUS_M + geometric_altitude_m)
135}
136
137pub fn resolve_station_pressure(pressure_hpa: f64, altitude_m: f64) -> Option<f64> {
153 const SEA_LEVEL_HPA: f64 = 1013.25;
154 if (pressure_hpa - SEA_LEVEL_HPA).abs() < 0.5 && altitude_m.abs() > 1.0 {
155 None } else {
157 Some(pressure_hpa) }
159}
160
161pub fn resolve_station_temperature(temperature_c: f64, altitude_m: f64) -> Option<f64> {
177 const SEA_LEVEL_TEMP_C: f64 = 15.0;
178 if (temperature_c - SEA_LEVEL_TEMP_C).abs() < 0.1 && altitude_m.abs() > 1.0 {
179 None } else {
181 Some(temperature_c) }
183}
184
185pub fn resolve_station_conditions(
188 temperature_c: f64,
189 pressure_hpa: f64,
190 altitude_m: f64,
191) -> (f64, f64) {
192 let temp_override = resolve_station_temperature(temperature_c, altitude_m);
193 let press_override = resolve_station_pressure(pressure_hpa, altitude_m);
194 let (std_temp_k, std_pressure_pa) = calculate_icao_standard_atmosphere(altitude_m);
195 let temp_c = temp_override.unwrap_or(std_temp_k - 273.15);
196 let pressure_hpa = press_override.unwrap_or(std_pressure_pa / 100.0);
197 (temp_c, pressure_hpa)
198}
199
200pub fn calculate_atmosphere(
211 altitude_m: f64,
212 temp_override_c: Option<f64>,
213 press_override_hpa: Option<f64>,
214 humidity_percent: f64,
215) -> (f64, f64) {
216 let (temp_k, pressure_pa) = if temp_override_c.is_some() && press_override_hpa.is_some() {
218 (
220 temp_override_c.unwrap() + 273.15,
221 press_override_hpa.unwrap() * 100.0,
222 )
223 } else {
224 let (std_temp_k, std_pressure_pa) = calculate_icao_standard_atmosphere(altitude_m);
226
227 let final_temp_k = if let Some(temp_c) = temp_override_c {
228 temp_c + 273.15
229 } else {
230 std_temp_k
231 };
232
233 let final_pressure_pa = if let Some(press_hpa) = press_override_hpa {
234 press_hpa * 100.0
235 } else {
236 std_pressure_pa
237 };
238
239 (final_temp_k, final_pressure_pa)
240 };
241
242 let humidity_clamped = humidity_percent.clamp(0.0, 100.0);
244 let temp_c = temp_k - 273.15;
245
246 let density = calculate_air_density_cimp(temp_c, pressure_pa / 100.0, humidity_clamped);
250
251 let speed_of_sound = moist_speed_of_sound(temp_k, pressure_pa, humidity_clamped);
257
258 (density, speed_of_sound)
259}
260
261pub fn moist_speed_of_sound(temp_k: f64, pressure_pa: f64, humidity_percent: f64) -> f64 {
280 let humidity_clamped = humidity_percent.clamp(0.0, 100.0);
281 let temp_c = temp_k - 273.15;
282
283 let p_sv_hpa = enhanced_saturation_vapor_pressure(temp_k);
287 let f = enhanced_enhancement_factor(pressure_pa, temp_c);
288 let vapor_pressure_pa = humidity_clamped / 100.0 * f * p_sv_hpa * 100.0;
289
290 let mole_fraction_vapor = (vapor_pressure_pa / pressure_pa.max(f64::MIN_POSITIVE)).min(1.0);
293
294 let gamma_moist = GAMMA * (1.0 - mole_fraction_vapor * 0.062);
298 let r_moist = R_AIR * (1.0 + 0.378 * mole_fraction_vapor);
299
300 (gamma_moist * r_moist * temp_k).sqrt()
301}
302
303pub fn calculate_air_density_cimp(temp_c: f64, pressure_hpa: f64, humidity_percent: f64) -> f64 {
313 let t_k = temp_c + 273.15;
314
315 let p_sv = enhanced_saturation_vapor_pressure(t_k);
317
318 let pressure_pa = pressure_hpa * 100.0;
319
320 let f = enhanced_enhancement_factor(pressure_pa, temp_c);
322
323 let p_v = humidity_percent.clamp(0.0, 100.0) / 100.0 * f * p_sv;
326
327 let p_v_pa = p_v * 100.0;
333
334 let p_pa = pressure_pa.max(f64::MIN_POSITIVE);
337
338 let x_v = (p_v_pa / p_pa).min(1.0);
340
341 let z = enhanced_compressibility_factor(p_pa, t_k, x_v);
343
344 ((p_pa * M_A) / (z * R * t_k)) * (1.0 - x_v * (1.0 - M_V / M_A))
347}
348
349#[inline(always)]
352fn enhanced_saturation_vapor_pressure(t_k: f64) -> f64 {
353 const A: [f64; 6] = [
355 -7.85951783,
356 1.84408259,
357 -11.7866497,
358 22.6807411,
359 -15.9618719,
360 1.80122502,
361 ];
362
363 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)
368 * (A[0] * tau
369 + A[1] * tau.powf(1.5)
370 + A[2] * tau.powf(3.0)
371 + A[3] * tau.powf(3.5)
372 + A[4] * tau.powf(4.0)
373 + A[5] * tau.powf(7.5));
374
375 220640.0 * ln_p_ratio.exp() }
377
378#[inline(always)]
380fn enhanced_enhancement_factor(p: f64, t: f64) -> f64 {
381 const ALPHA: f64 = 1.00062;
382 const BETA: f64 = 3.14e-8;
383 const GAMMA: f64 = 5.6e-7;
384
385 ALPHA + BETA * p + GAMMA * t * t
386}
387
388#[inline(always)]
390fn enhanced_compressibility_factor(p: f64, t_k: f64, x_v: f64) -> f64 {
391 const A0: f64 = 1.58123e-6;
393 const A1: f64 = -2.9331e-8;
394 const A2: f64 = 1.1043e-10;
395 const B0: f64 = 5.707e-6;
396 const B1: f64 = -2.051e-8;
397 const C0: f64 = 1.9898e-4;
398 const C1: f64 = -2.376e-6;
399 const D: f64 = 1.83e-11;
400 const E: f64 = -0.765e-8;
401
402 let t_k_safe = t_k.max(173.15); let t = t_k_safe - 273.15;
405 let p_t = p / t_k_safe;
406
407 let z_second_order =
408 1.0 - p_t * (A0 + A1 * t + A2 * t * t + (B0 + B1 * t) * x_v + (C0 + C1 * t) * x_v * x_v);
409
410 let z_third_order = p_t * p_t * (D + E * x_v * x_v);
411
412 z_second_order + z_third_order
413}
414
415#[inline]
421pub(crate) fn shot_frame_altitude(
422 base_altitude_m: f64,
423 downrange_m: f64,
424 shot_y_m: f64,
425 shooting_angle_rad: f64,
426) -> f64 {
427 base_altitude_m
428 + downrange_m * shooting_angle_rad.sin()
429 + shot_y_m * shooting_angle_rad.cos()
430}
431
432pub fn get_local_atmosphere(
444 altitude_m: f64,
445 base_alt: f64,
446 base_temp_c: f64,
447 base_press_hpa: f64,
448 base_ratio: f64,
449) -> (f64, f64) {
450 let (temp_k, _pressure_pa, density) =
451 local_temp_pressure_density(altitude_m, base_alt, base_temp_c, base_press_hpa, base_ratio);
452
453 let speed_of_sound = (temp_k * 401.874).sqrt();
456
457 (density, speed_of_sound)
458}
459
460pub fn get_local_atmosphere_humid(
478 altitude_m: f64,
479 base_alt: f64,
480 base_temp_c: f64,
481 base_press_hpa: f64,
482 base_ratio: f64,
483 humidity_percent: f64,
484) -> (f64, f64) {
485 let (temp_k, pressure_pa, density) =
486 local_temp_pressure_density(altitude_m, base_alt, base_temp_c, base_press_hpa, base_ratio);
487 (density, moist_speed_of_sound(temp_k, pressure_pa, humidity_percent))
488}
489
490#[inline]
493fn local_temp_pressure_density(
494 altitude_m: f64,
495 base_alt: f64,
496 base_temp_c: f64,
497 base_press_hpa: f64,
498 base_ratio: f64,
499) -> (f64, f64, f64) {
500 let base_temp_k = base_temp_c + 273.15;
501
502 if !altitude_m.is_finite() || !base_alt.is_finite() {
505 return (f64::NAN, f64::NAN, f64::NAN);
506 }
507
508 let base_geopotential_m = geometric_to_geopotential_height_m(base_alt);
509 let target_geopotential_m = geometric_to_geopotential_height_m(altitude_m);
510 let (temp_k, pressure_hpa) = integrate_local_atmosphere_layers(
511 base_geopotential_m,
512 target_geopotential_m,
513 base_temp_k,
514 base_press_hpa,
515 );
516
517 let density_ratio = base_ratio * (base_temp_k * pressure_hpa) / (base_press_hpa * temp_k);
519 let density = density_ratio * 1.225;
520
521 (temp_k, pressure_hpa * 100.0, density)
522}
523
524fn integrate_local_atmosphere_layers(
528 base_geopotential_m: f64,
529 target_geopotential_m: f64,
530 mut temp_k: f64,
531 mut pressure_hpa: f64,
532) -> (f64, f64) {
533 let mut current_alt = base_geopotential_m;
534
535 if target_geopotential_m > current_alt {
536 while current_alt < target_geopotential_m {
537 let layer_index = ICAO_LAYERS
539 .iter()
540 .rposition(|layer| current_alt >= layer.base_altitude)
541 .unwrap_or(0);
542 let segment_end = ICAO_LAYERS
543 .get(layer_index + 1)
544 .map_or(target_geopotential_m, |next| {
545 target_geopotential_m.min(next.base_altitude)
546 });
547 (temp_k, pressure_hpa) = integrate_local_atmosphere_segment(
548 temp_k,
549 pressure_hpa,
550 segment_end - current_alt,
551 ICAO_LAYERS[layer_index].lapse_rate,
552 );
553 current_alt = segment_end;
554 }
555 } else {
556 while current_alt > target_geopotential_m {
557 let layer_index = ICAO_LAYERS
560 .iter()
561 .rposition(|layer| current_alt > layer.base_altitude)
562 .unwrap_or(0);
563 let segment_end = if layer_index == 0 {
564 target_geopotential_m
565 } else {
566 target_geopotential_m.max(ICAO_LAYERS[layer_index].base_altitude)
567 };
568 (temp_k, pressure_hpa) = integrate_local_atmosphere_segment(
569 temp_k,
570 pressure_hpa,
571 segment_end - current_alt,
572 ICAO_LAYERS[layer_index].lapse_rate,
573 );
574 current_alt = segment_end;
575 }
576 }
577
578 (temp_k, pressure_hpa)
579}
580
581#[inline]
582fn integrate_local_atmosphere_segment(
583 base_temp_k: f64,
584 base_pressure_hpa: f64,
585 height_diff: f64,
586 lapse_rate: f64,
587) -> (f64, f64) {
588 let temp_k = base_temp_k + lapse_rate * height_diff;
589 let pressure_hpa = if lapse_rate.abs() < 1e-10 {
590 base_pressure_hpa * (-G_ACCEL_MPS2 * height_diff / (R_AIR * base_temp_k)).exp()
591 } else {
592 let temp_ratio = temp_k / base_temp_k;
593 base_pressure_hpa * temp_ratio.powf(-G_ACCEL_MPS2 / (lapse_rate * R_AIR))
594 };
595
596 (temp_k, pressure_hpa)
597}
598
599#[cfg(test)]
601#[inline(always)]
602fn determine_local_lapse_rate(altitude_m: f64) -> f64 {
603 let layer = ICAO_LAYERS
605 .iter()
606 .rev()
607 .find(|layer| altitude_m >= layer.base_altitude)
608 .unwrap_or(&ICAO_LAYERS[0]);
609
610 layer.lapse_rate
611}
612
613#[inline(always)]
622pub fn get_direct_atmosphere(density: f64, speed_of_sound: f64) -> (f64, f64) {
623 (density, speed_of_sound)
624}
625
626pub fn calculate_air_density_cipm(temp_c: f64, pressure_hpa: f64, humidity_percent: f64) -> f64 {
628 calculate_air_density_cimp(temp_c, pressure_hpa, humidity_percent)
629}
630
631pub type AtmoSegment = (f64, f64, f64, f64);
639
640#[derive(Debug, Clone)]
651pub struct AtmoSock {
652 segments: Vec<AtmoSegment>,
654}
655
656impl AtmoSock {
657 pub fn new(mut segments: Vec<AtmoSegment>) -> Self {
662 segments.sort_by(|a, b| match (a.3.is_nan(), b.3.is_nan()) {
663 (true, true) => Ordering::Equal,
664 (true, false) => Ordering::Greater,
665 (false, true) => Ordering::Less,
666 (false, false) => a.3.partial_cmp(&b.3).unwrap(),
667 });
668 AtmoSock { segments }
669 }
670
671 pub fn is_empty(&self) -> bool {
673 self.segments.is_empty()
674 }
675
676 pub fn atmo_for_range(&self, downrange_m: f64) -> (f64, f64, f64) {
687 if self.segments.is_empty() {
688 return (15.0, 1013.25, 0.0); }
690 if downrange_m.is_nan() {
692 let s = self.segments[0];
693 return (s.0, s.1, s.2);
694 }
695 for seg in &self.segments {
696 if downrange_m < seg.3 {
697 return (seg.0, seg.1, seg.2);
698 }
699 }
700 let last = self.segments[self.segments.len() - 1];
702 (last.0, last.1, last.2)
703 }
704}
705
706#[cfg(test)]
707mod tests {
708 use super::*;
709
710 #[test]
711 fn inclined_shot_frame_position_maps_to_world_altitude() {
712 let base_altitude = 100.0;
713 let downrange = 1_000.0;
714 let shot_y = 10.0;
715 let angle = std::f64::consts::FRAC_PI_6;
716 let expected = base_altitude + downrange * angle.sin() + shot_y * angle.cos();
717
718 let actual = shot_frame_altitude(base_altitude, downrange, shot_y, angle);
719 assert!(
720 (actual - expected).abs() < 1e-12,
721 "30-degree shot at x=1000/y=10 should be at {expected} m, got {actual} m"
722 );
723 assert_eq!(
724 shot_frame_altitude(base_altitude, downrange, shot_y, 0.0),
725 base_altitude + shot_y,
726 "flat-fire altitude must remain byte-identical"
727 );
728 let downhill = shot_frame_altitude(base_altitude, downrange, shot_y, -angle);
729 let expected_downhill = base_altitude - downrange * angle.sin() + shot_y * angle.cos();
730 assert!((downhill - expected_downhill).abs() < 1e-12);
731 }
732
733 #[test]
741 fn test_mba1136_dry_sea_level_reference() {
742 let (density, sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
743 assert!(
744 (density - 1.225).abs() < 0.002,
745 "dry sea-level density {density} not within 1.225 +- 0.002"
746 );
747 assert!(
748 (sos - 340.3).abs() < 0.6,
749 "dry sea-level speed of sound {sos} not within 340.3 +- 0.6"
750 );
751 }
752
753 #[test]
756 fn test_mba1136_humid_lighter_than_dry() {
757 let (dry_rho, dry_sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
758 let (moist_rho, moist_sos) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 50.0);
759
760 assert!(
761 (moist_rho - 1.2211).abs() < 0.002,
762 "50% RH density {moist_rho} not within CIPM 1.2211 +- 0.002"
763 );
764 assert!(
765 moist_rho < dry_rho,
766 "moist air ({moist_rho}) must be lighter than dry ({dry_rho})"
767 );
768 assert!(
769 moist_sos > dry_sos,
770 "moist speed of sound ({moist_sos}) must exceed dry ({dry_sos})"
771 );
772 }
773
774 #[test]
776 fn test_mba1136_density_monotone_in_humidity() {
777 let (rho_0, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 0.0);
778 let (rho_50, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 50.0);
779 let (rho_100, _) = calculate_atmosphere(0.0, Some(15.0), Some(1013.25), 100.0);
780 assert!(
781 rho_100 < rho_50 && rho_50 < rho_0,
782 "humidity monotonicity violated: 100%={rho_100}, 50%={rho_50}, 0%={rho_0}"
783 );
784 }
785
786 #[test]
789 fn test_mba1136_atmosphere_density_is_cipm() {
790 for (t, p, h) in [
791 (15.0, 1013.25, 0.0),
792 (15.0, 1013.25, 50.0),
793 (30.0, 1000.0, 80.0),
794 (-10.0, 1020.0, 20.0),
795 ] {
796 let (density, _) = calculate_atmosphere(0.0, Some(t), Some(p), h);
797 let cipm = calculate_air_density_cimp(t, p, h);
798 assert_eq!(
799 density, cipm,
800 "calculate_atmosphere density must equal CIPM at {t}C/{p}hPa/{h}%"
801 );
802 }
803 }
804
805 #[test]
808 fn test_mba1136_moist_speed_of_sound_extraction() {
809 for (t, p, h) in [
810 (15.0, 1013.25, 0.0),
811 (15.0, 1013.25, 50.0),
812 (25.0, 900.0, 100.0),
813 ] {
814 let (_, sos) = calculate_atmosphere(0.0, Some(t), Some(p), h);
815 let extracted = moist_speed_of_sound(t + 273.15, p * 100.0, h);
816 assert_eq!(
817 sos, extracted,
818 "extracted moist_speed_of_sound must match calculate_atmosphere at {t}C/{p}hPa/{h}%"
819 );
820 }
821 }
822
823 #[test]
826 fn test_mba1136_get_local_atmosphere_reference() {
827 let (d0, c0) = get_local_atmosphere(500.0, 500.0, 10.0, 950.0, 1.05);
828 assert!(
829 (d0 - 1.286250000000).abs() < 1e-9,
830 "local density@500m drifted: {d0}"
831 );
832 assert!(
833 (c0 - 337.328657395129).abs() < 1e-9,
834 "local sos@500m drifted: {c0}"
835 );
836 let (d1, c1) = get_local_atmosphere(1500.0, 500.0, 10.0, 950.0, 1.05);
837 assert!(
838 (d1 - 1.165238292559).abs() < 1e-9,
839 "local density@1500m drifted: {d1}"
840 );
841 assert!(
842 (c1 - 333.435546617978).abs() < 1e-9,
843 "local sos@1500m drifted: {c1}"
844 );
845 }
846
847 #[test]
848 fn fractional_station_altitude_is_not_quantized() {
849 let station_altitude_m = 500.25;
850 let station_temp_c = 10.0;
851 let station_pressure_hpa = 950.0;
852 let station_density_ratio = 1.05;
853
854 let (density, speed_of_sound) = get_local_atmosphere(
855 station_altitude_m,
856 station_altitude_m,
857 station_temp_c,
858 station_pressure_hpa,
859 station_density_ratio,
860 );
861
862 let expected_density = station_density_ratio * 1.225;
863 let expected_speed_of_sound = ((station_temp_c + 273.15) * 401.874).sqrt();
864 assert!((density - expected_density).abs() < 1e-12);
865 assert!((speed_of_sound - expected_speed_of_sound).abs() < 1e-12);
866 }
867
868 #[test]
872 fn test_mba1136_get_local_atmosphere_humid() {
873 let (d_dry, c_dry) = get_local_atmosphere(1500.0, 500.0, 10.0, 950.0, 1.05);
874 let (d_h0, c_h0) = get_local_atmosphere_humid(1500.0, 500.0, 10.0, 950.0, 1.05, 0.0);
875 assert_eq!(d_dry, d_h0, "humid variant must not change density");
876 assert!(
877 (c_h0 - c_dry).abs() < 1e-3,
878 "0% RH humid sos {c_h0} should match dry sos {c_dry}"
879 );
880 let (_, c_h80) = get_local_atmosphere_humid(1500.0, 500.0, 10.0, 950.0, 1.05, 80.0);
881 assert!(c_h80 > c_dry, "humid sos {c_h80} should exceed dry {c_dry}");
882 }
883
884 #[test]
885 fn test_icao_standard_atmosphere() {
886 let (temp, press) = calculate_icao_standard_atmosphere(0.0);
888 assert!((temp - 288.15).abs() < 0.01);
889 assert!((press - 101325.0).abs() < 1.0);
890
891 let geometric_tropopause_m =
894 GEOPOTENTIAL_EARTH_RADIUS_M * 11000.0 / (GEOPOTENTIAL_EARTH_RADIUS_M - 11000.0);
895 let (temp_11km, press_11km) = calculate_icao_standard_atmosphere(geometric_tropopause_m);
896 assert!((temp_11km - 216.65).abs() < 0.01);
897 assert!((press_11km - 22632.1).abs() < 1.0);
898
899 let (temp_25km, _) = calculate_icao_standard_atmosphere(25000.0);
901 assert!(temp_25km > 216.65); }
903
904 #[test]
905 fn standard_atmosphere_extends_below_sea_level() {
906 let altitude_m = -430.0;
907 let (temp_k, pressure_pa) = calculate_icao_standard_atmosphere(altitude_m);
908
909 assert!((temp_k - 290.945_189_079_054).abs() < 1e-9);
910 assert!((pressure_pa - 106_598.763_552_437).abs() < 0.1);
911
912 let (station_temp_c, station_pressure_hpa) =
913 resolve_station_conditions(15.0, 1013.25, altitude_m);
914 assert!((station_temp_c - 17.795_189_079_054).abs() < 1e-9);
915 assert!((station_pressure_hpa - 1_065.987_635_524).abs() < 1e-6);
916
917 let (sea_density, _) = calculate_atmosphere(0.0, None, None, 0.0);
918 let (below_sea_density, _) = calculate_atmosphere(altitude_m, None, None, 0.0);
919 assert!((below_sea_density - 1.276_908_642_79).abs() < 1e-6);
920 assert!(below_sea_density > sea_density * 1.04);
921
922 assert_eq!(
923 calculate_icao_standard_atmosphere(-6000.0),
924 calculate_icao_standard_atmosphere(MIN_GEOMETRIC_ALTITUDE_M)
925 );
926 }
927
928 #[test]
929 fn standard_atmosphere_converts_geometric_to_geopotential_height() {
930 let cases: [(f64, f64, f64); 3] = [
931 (10_000.0, 223.252_092_647_979, 26_499.901_600_244),
932 (30_000.0, 226.509_083_611_330, 1_197.032_108_466),
933 (84_000.0, 190.841_043_736_102, 0.531_525_514_935),
934 ];
935 for (geometric_m, expected_temp_k, expected_pressure_pa) in cases {
936 let (temp_k, pressure_pa) = calculate_icao_standard_atmosphere(geometric_m);
937 let pressure_tolerance = expected_pressure_pa.max(1.0_f64) * 1e-6;
938
939 assert!((temp_k - expected_temp_k).abs() < 1e-9);
940 assert!((pressure_pa - expected_pressure_pa).abs() < pressure_tolerance);
941 }
942 }
943
944 #[test]
945 fn local_atmosphere_walks_icao_layers_continuously() {
946 for altitude_m in [
947 10999.0, 11000.0, 11001.0, 11050.0, 19999.0, 20000.0, 20001.0, 25000.0,
948 ] {
949 let (local_temp_k, local_pressure_pa, _) =
950 local_temp_pressure_density(altitude_m, 0.0, 15.0, 1013.25, 1.0);
951 let (standard_temp_k, standard_pressure_pa) =
952 calculate_icao_standard_atmosphere(altitude_m);
953
954 assert!(
955 (local_temp_k - standard_temp_k).abs() < 1e-9,
956 "local temperature diverged from ICAO at {altitude_m} m: local={local_temp_k}, standard={standard_temp_k}"
957 );
958 assert!(
959 ((local_pressure_pa - standard_pressure_pa) / standard_pressure_pa).abs() < 5e-5,
960 "local pressure diverged from ICAO at {altitude_m} m: local={local_pressure_pa}, standard={standard_pressure_pa}"
961 );
962 }
963
964 let (density_below, sound_below) =
965 get_local_atmosphere(10999.0, 0.0, 15.0, 1013.25, 1.0);
966 let (density_above, sound_above) =
967 get_local_atmosphere(11001.0, 0.0, 15.0, 1013.25, 1.0);
968 assert!(
969 (density_below - density_above).abs() < 0.001,
970 "density jumped across 11 km: below={density_below}, above={density_above}"
971 );
972 assert!(
973 (sound_below - sound_above).abs() < 0.1,
974 "speed of sound jumped across 11 km: below={sound_below}, above={sound_above}"
975 );
976 }
977
978 #[test]
979 fn local_atmosphere_preserves_nonstandard_station_offset_and_round_trips() {
980 let base_alt = 7500.0;
981 let base_temp_c = 5.0;
982 let base_pressure_hpa = 410.0;
983 let base_ratio = 0.72;
984
985 let (high_temp_k, high_pressure_pa, high_density) = local_temp_pressure_density(
986 25000.0,
987 base_alt,
988 base_temp_c,
989 base_pressure_hpa,
990 base_ratio,
991 );
992 assert!((high_temp_k - 260.244_615_053_376).abs() < 1e-9);
993 assert!((high_pressure_pa / 100.0 - 40.964_358_485_456).abs() < 1e-9);
994 assert!((high_density - 0.094_186_400_274).abs() < 1e-9);
995
996 let (back_temp_k, back_pressure_pa, back_density) = local_temp_pressure_density(
997 base_alt,
998 25000.0,
999 high_temp_k - 273.15,
1000 high_pressure_pa / 100.0,
1001 high_density / 1.225,
1002 );
1003 assert!((back_temp_k - (base_temp_c + 273.15)).abs() < 1e-9);
1004 assert!((back_pressure_pa / 100.0 - base_pressure_hpa).abs() < 1e-8);
1005 assert!((back_density - base_ratio * 1.225).abs() < 1e-9);
1006 }
1007
1008 #[test]
1009 fn test_enhanced_atmosphere_sea_level() {
1010 let (density, speed) = calculate_atmosphere(0.0, None, None, 0.0);
1011 assert!((density - 1.225).abs() < 0.01);
1012 assert!((speed - 340.0).abs() < 1.0);
1013 }
1014
1015 #[test]
1016 fn test_resolve_station_pressure_contract() {
1017 assert_eq!(resolve_station_pressure(1013.25, 2000.0), None);
1019 assert_eq!(resolve_station_pressure(1013.21, 2000.0), None);
1021 assert_eq!(resolve_station_pressure(850.0, 2000.0), Some(850.0));
1023 assert_eq!(resolve_station_pressure(1013.25, 0.0), Some(1013.25));
1025 }
1026
1027 #[test]
1028 fn test_altitude_affects_density_with_default_pressure() {
1029 let press = resolve_station_pressure(1013.25, 0.0);
1032 let (rho_sea, _) = calculate_atmosphere(0.0, Some(15.0), press, 50.0);
1033 let press_alt = resolve_station_pressure(1013.25, 2000.0);
1034 let (rho_2km, _) = calculate_atmosphere(2000.0, Some(15.0), press_alt, 50.0);
1035 assert!(
1036 rho_2km < rho_sea * 0.9,
1037 "density at 2000 m ({rho_2km}) should be well below sea level ({rho_sea})"
1038 );
1039
1040 let p = resolve_station_pressure(900.0, 2000.0);
1043 let (rho_a, _) = calculate_atmosphere(2000.0, Some(15.0), p, 50.0);
1044 let (rho_b, _) = calculate_atmosphere(0.0, Some(15.0), p, 50.0);
1045 assert!(
1046 (rho_a - rho_b).abs() < 1e-9,
1047 "explicit pressure must ignore altitude"
1048 );
1049 }
1050
1051 #[test]
1052 fn test_resolve_station_temperature_contract() {
1053 assert_eq!(resolve_station_temperature(15.0, 2000.0), None);
1055 assert_eq!(resolve_station_temperature(-5.0, 2000.0), Some(-5.0));
1057 assert_eq!(resolve_station_temperature(30.0, 2000.0), Some(30.0));
1058 assert_eq!(resolve_station_temperature(15.0, 0.0), Some(15.0));
1060 }
1061
1062 #[test]
1063 fn test_altitude_only_default_matches_full_icao_standard() {
1064 for alt in [1000.0, 2000.0, 2500.0, 3000.0] {
1070 let t = resolve_station_temperature(15.0, alt);
1071 let p = resolve_station_pressure(1013.25, alt);
1072 let (rho_resolved, _) = calculate_atmosphere(alt, t, p, 0.0);
1073 let (rho_std, _) = calculate_atmosphere(alt, None, None, 0.0);
1074 assert!(
1075 (rho_resolved - rho_std).abs() < 1e-9,
1076 "alt {alt}: altitude-only default density {rho_resolved} should equal the full \
1077 ICAO standard {rho_std}"
1078 );
1079 let (rho_warm, _) = calculate_atmosphere(alt, Some(15.0), p, 0.0);
1081 assert!(
1082 rho_resolved > rho_warm,
1083 "alt {alt}: lapse-temperature density {rho_resolved} should exceed 15 C-held {rho_warm}"
1084 );
1085 }
1086 }
1087
1088 #[test]
1089 fn test_enhanced_atmosphere_with_humidity() {
1090 let (density_dry, speed_dry) = calculate_atmosphere(0.0, None, None, 0.0);
1091 let (density_humid, speed_humid) = calculate_atmosphere(0.0, None, None, 80.0);
1092
1093 assert!(density_humid < density_dry);
1095 assert!(speed_humid > speed_dry);
1097 }
1098
1099 #[test]
1100 fn test_enhanced_atmosphere_stratosphere() {
1101 let (density_20km, speed_20km) = calculate_atmosphere(20000.0, None, None, 0.0);
1103 let (density_30km, speed_30km) = calculate_atmosphere(30000.0, None, None, 0.0);
1104
1105 assert!(density_30km < density_20km);
1107 assert!(speed_30km > speed_20km);
1109 }
1110
1111 #[test]
1112 fn test_enhanced_cimp_density() {
1113 let density = calculate_air_density_cimp(15.0, 1013.25, 0.0);
1114 assert!((density - 1.225).abs() < 0.01);
1115
1116 let density_humid = calculate_air_density_cimp(15.0, 1013.25, 50.0);
1118 assert!(density_humid < density);
1119 }
1120
1121 #[test]
1122 fn test_cipm_moist_air_matches_python_reference() {
1123 let cases = [
1130 (15.0, 1013.25, 50.0, 1.221125867723075),
1131 (30.0, 1000.0, 80.0, 1.1344071877123691),
1132 (-10.0, 1020.0, 20.0, 1.3500610713710515),
1133 ];
1134 for (temp_c, pressure_hpa, humidity_pct, expected) in cases {
1135 let density = calculate_air_density_cipm(temp_c, pressure_hpa, humidity_pct);
1136 let rel_err = ((density - expected) / expected).abs();
1137 assert!(
1138 rel_err < 1e-3,
1139 "CIPM density at {temp_c} C / {pressure_hpa} hPa / {humidity_pct}% RH: \
1140 got {density}, expected {expected} (rel err {rel_err:.2e} >= 1e-3)"
1141 );
1142 }
1143
1144 let dry = calculate_air_density_cipm(15.0, 1013.25, 0.0);
1147 let moist = calculate_air_density_cipm(15.0, 1013.25, 50.0);
1148 assert!(
1149 dry - moist > 3e-3,
1150 "humidity effect too small: dry {dry} vs 50% RH {moist}"
1151 );
1152 }
1153
1154 #[test]
1155 fn test_variable_lapse_rates() {
1156 let lapse_tropo = determine_local_lapse_rate(5000.0);
1158 let lapse_strato = determine_local_lapse_rate(25000.0);
1159
1160 assert!((lapse_tropo - (-0.0065)).abs() < 0.0001);
1161 assert!(lapse_strato > 0.0); }
1163
1164 #[test]
1167 fn test_atmo_sock_empty_falls_back_to_isa() {
1168 let sock = AtmoSock::new(vec![]);
1169 assert!(sock.is_empty());
1170 assert_eq!(sock.atmo_for_range(0.0), (15.0, 1013.25, 0.0));
1172 assert_eq!(sock.atmo_for_range(500.0), (15.0, 1013.25, 0.0));
1173 }
1174
1175 #[test]
1176 fn test_atmo_sock_single_segment_holds_beyond_last() {
1177 let sock = AtmoSock::new(vec![(25.0, 1000.0, 30.0, 100.0)]);
1180 assert_eq!(sock.atmo_for_range(50.0), (25.0, 1000.0, 30.0));
1181 assert_eq!(sock.atmo_for_range(100.0), (25.0, 1000.0, 30.0)); assert_eq!(sock.atmo_for_range(5000.0), (25.0, 1000.0, 30.0));
1183 }
1184
1185 #[test]
1186 fn test_atmo_sock_boundary_is_upper_exclusive() {
1187 let sock = AtmoSock::new(vec![
1190 (30.0, 1010.0, 80.0, 100.0), (-5.0, 900.0, 10.0, 200.0), ]);
1193 assert_eq!(sock.atmo_for_range(99.999), (30.0, 1010.0, 80.0));
1195 assert_eq!(sock.atmo_for_range(100.0), (-5.0, 900.0, 10.0));
1197 assert_eq!(sock.atmo_for_range(200.0), (-5.0, 900.0, 10.0));
1199 assert_eq!(sock.atmo_for_range(1e6), (-5.0, 900.0, 10.0));
1200 }
1201
1202 #[test]
1203 fn test_atmo_sock_sorts_unordered_segments() {
1204 let sock = AtmoSock::new(vec![
1206 (-5.0, 900.0, 10.0, 200.0),
1207 (30.0, 1010.0, 80.0, 100.0),
1208 ]);
1209 assert_eq!(sock.atmo_for_range(50.0), (30.0, 1010.0, 80.0));
1210 assert_eq!(sock.atmo_for_range(150.0), (-5.0, 900.0, 10.0));
1211 }
1212
1213 #[test]
1214 fn test_atmo_sock_orders_nan_thresholds_last() {
1215 let positive_nan = f64::from_bits(0x7ff8_0000_0000_0001);
1216 let negative_nan = f64::from_bits(0xfff8_0000_0000_0002);
1217 let sock = AtmoSock::new(vec![
1218 (97.0, 997.0, 97.0, positive_nan),
1219 (30.0, 1030.0, 30.0, 300.0),
1220 (98.0, 998.0, 98.0, negative_nan),
1221 (10.0, 1010.0, 10.0, 100.0),
1222 (99.0, 999.0, 99.0, f64::NAN),
1223 (20.0, 1020.0, 20.0, 200.0),
1224 ]);
1225
1226 let thresholds: Vec<_> = sock.segments.iter().map(|segment| segment.3).collect();
1227 assert_eq!(&thresholds[..3], &[100.0, 200.0, 300.0]);
1228 assert!(thresholds[3..].iter().all(|threshold| threshold.is_nan()));
1229 assert_eq!(sock.atmo_for_range(f64::NAN), (10.0, 1010.0, 10.0));
1230 assert_eq!(sock.atmo_for_range(350.0), (99.0, 999.0, 99.0));
1231 }
1232
1233 #[test]
1234 fn test_atmo_sock_nan_uses_first_zone() {
1235 let sock = AtmoSock::new(vec![
1236 (30.0, 1010.0, 80.0, 100.0),
1237 (-5.0, 900.0, 10.0, 200.0),
1238 ]);
1239 assert_eq!(sock.atmo_for_range(f64::NAN), (30.0, 1010.0, 80.0));
1241 }
1242}