zmatrix 0.4.2

Compile-time dimensional analysis & physics-aware linear algebra for aerospace and robotics
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
74
75
76
77
78

use std::ops::Neg;

pub fn sgn(xin: f64) -> f64 {
    if xin > 0.0 {
        return 1.0;
    } else {
        return -1.0;
    }
}
// 符号函数
pub fn sgn2_64(xin: f64) -> i32 {
    if xin > 0.0 {
        1
    } else if xin == 0.0 {
        0
    } else {
        -1
    }
}

pub fn limit_float<T>(fin: T, f_bound: T) -> T
where
    T: Default + Copy + PartialOrd + Neg<Output = T>,
{
    let f_value: T;

    // 输入值 fin，限幅阈值 f_bound，必须大于 0
    if fin > f_bound {
        // 大于上限值
        // 高于上限则取上限
        f_value = f_bound;
    } else if fin < -f_bound {
        // 小于下限值
        // 低于下限则取下限
        f_value = -f_bound;
    } else {
        // 其他情况
        // 在上下限之间保持不变
        f_value = fin;
    }

    f_value
}

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

    #[test]
    fn test_sgn2_64() {
        // 测试正数
        assert_eq!(sgn2_64(10.0), 1);
        // 测试负数
        assert_eq!(sgn2_64(-5.0), -1);
        // 测试零
        assert_eq!(sgn2_64(0.0), 0);
    }

    #[test]
    fn test_limit_float() {
        assert_relative_eq!(limit_float(0.0, 1.0), 0.0);
        assert_relative_eq!(limit_float(-0.0, 1.0), 0.0);
        assert_relative_eq!(limit_float(1.0, 1.0), 1.0);
        assert_relative_eq!(limit_float(-1.0, 1.0), -1.0);
        assert_relative_eq!(limit_float(1.8, 1.0), 1.0);
        assert_relative_eq!(limit_float(-1.8, 1.0), -1.0);
        assert_relative_eq!(limit_float(0.5, 1.0), 0.5);
    }

    #[test]
    fn test_sgn() {
        assert_relative_eq!(sgn(0.0), -1.0);
        assert_relative_eq!(sgn(-0.0), -1.0);
        assert_relative_eq!(sgn(1.0), 1.0);
        assert_relative_eq!(sgn(-1.0), -1.0);
    }
}