protoflight 0.1.2

Protoflight flight controller.
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

#![cfg(feature = "autopilot")]

use sensor_fusion::AltitudeKalmanFilterf32;
#[cfg(any(feature = "gps", feature = "optical_flow"))]
use sensor_fusion::PositionKalmanFilterf32;

use crate::autopilot::altitude_dual_ring_pid::AltitudeDualRingPid;

#[derive(Clone, Copy, Debug, PartialEq)]
pub struct Autopilot {
    pub altitude_controller: AltitudeDualRingPid,
    pub altitude_kalman_filter: AltitudeKalmanFilterf32,
    #[cfg(any(feature = "gps", feature = "optical_flow"))]
    pub position_kalman_filter: PositionKalmanFilterf32,
}

impl Default for Autopilot {
    fn default() -> Self {
        Self::new()
    }
}

impl Autopilot {
    pub const fn new() -> Self {
        Self {
            altitude_controller: AltitudeDualRingPid::new(0.0),
            altitude_kalman_filter: AltitudeKalmanFilterf32::new(),
            #[cfg(any(feature = "gps", feature = "optical_flow"))]
            position_kalman_filter: PositionKalmanFilterf32::new(),
        }
    }
}