cu-flight-controller 1.0.0

This is a basic quadcopter Flight Controller implemented end to end using Copper components
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

use super::*;
use cu_msp_bridge::MspRequestBatch;
use cu_msp_lib::structs::MspRequest;

#[derive(Reflect)]
pub struct FlowMspLogger;

impl Freezable for FlowMspLogger {}

impl CuSinkTask for FlowMspLogger {
    type Input<'m> = CuMsg<MspRequestBatch>;
    type Resources<'r> = ();

    fn new(_config: Option<&ComponentConfig>, _resources: Self::Resources<'_>) -> CuResult<Self>
    where
        Self: Sized,
    {
        Ok(Self)
    }

    fn process<'i>(&mut self, _ctx: &CuContext, input: &Self::Input<'i>) -> CuResult<()> {
        let Some(batch) = input.payload() else {
            return Ok(());
        };

        for request in batch.iter() {
            match request {
                MspRequest::MspSensorOpticFlow(flow) => {
                    debug!(
                        "                                                                              msp flow q={} dx={} dy={}",
                        flow.quality, flow.motion_x, flow.motion_y
                    );
                }
                MspRequest::MspSensorRangefinder(range) => {
                    debug!(
                        "msp range q={} dist_mm={}",
                        range.quality, range.distance_mm
                    );
                }
                _ => {}
            }
        }

        Ok(())
    }
}