avian_fdm 0.1.0

6-DoF Flight Dynamics Model for Bevy + Avian 0.6
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73

//! Throttle-to-thrust-fraction interpolation.

use avian3d::math::Scalar;
use crate::math::lerp_1d;

/// Linear interpolation over a `[[throttle, fraction]; N]` lookup table.
///
/// Clamps to the boundary values when `x` is outside the table range.
pub(crate) fn interp_curve(curve: &[[Scalar; 2]], x: Scalar) -> Scalar {
    if curve.is_empty() {
        return 0.0;
    }
    if curve.len() == 1 {
        return curve[0][1];
    }
    let x = x.clamp(curve[0][0], curve[curve.len() - 1][0]);
    let bp: Vec<Scalar> = curve.iter().map(|p| p[0]).collect();
    let vals: Vec<Scalar> = curve.iter().map(|p| p[1]).collect();
    lerp_1d(x, &bp, &vals)
}

#[cfg(test)]
mod tests {
    use super::*;

    #[test]
    fn linear_throttle_curve_midpoint() {
        let curve = vec![[0.0, 0.0], [1.0, 1.0]];
        assert!((interp_curve(&curve, 0.5) - 0.5).abs() < 1e-10);
    }

    #[test]
    fn throttle_curve_clamp_above() {
        let curve = vec![[0.0, 0.0], [1.0, 0.9]];
        assert!((interp_curve(&curve, 1.5) - 0.9).abs() < 1e-10);
    }

    #[test]
    fn throttle_curve_clamp_below() {
        let curve = vec![[0.2, 0.1], [1.0, 1.0]];
        assert!((interp_curve(&curve, 0.0) - 0.1).abs() < 1e-10);
    }

    #[test]
    fn interp_curve_empty_returns_zero() {
        assert_eq!(interp_curve(&[], 0.5), 0.0);
    }

    #[test]
    fn interp_curve_single_entry_returns_that_value() {
        let curve = vec![[0.5, 0.8]];
        assert!((interp_curve(&curve, 0.0) - 0.8).abs() < 1e-12, "below");
        assert!((interp_curve(&curve, 0.5) - 0.8).abs() < 1e-12, "exact");
        assert!((interp_curve(&curve, 1.0) - 0.8).abs() < 1e-12, "above");
    }

    #[test]
    fn interp_curve_three_breakpoints() {
        let curve = vec![[0.0, 0.0], [0.5, 0.6], [1.0, 1.0]];
        assert!((interp_curve(&curve, 0.0) - 0.0).abs() < 1e-12, "lower clamp");
        assert!((interp_curve(&curve, 0.25) - 0.3).abs() < 1e-12, "lower segment mid");
        assert!((interp_curve(&curve, 0.5) - 0.6).abs() < 1e-12, "breakpoint");
        assert!((interp_curve(&curve, 0.75) - 0.8).abs() < 1e-12, "upper segment mid");
        assert!((interp_curve(&curve, 1.0) - 1.0).abs() < 1e-12, "upper clamp");
    }

    #[test]
    fn interp_curve_clamps_outside_range() {
        let curve = vec![[0.2, 0.1], [0.8, 0.9]];
        assert!((interp_curve(&curve, 0.0) - 0.1).abs() < 1e-12, "below range clamps to first value");
        assert!((interp_curve(&curve, 1.0) - 0.9).abs() < 1e-12, "above range clamps to last value");
    }
}