mavlink 0.10.14

Implements the MAVLink data interchange format for UAVs.
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

use byteorder::ByteOrder;

use crate::error::*;

/// Replacement for std::io::Read + byteorder::ReadBytesExt in no_std envs
pub trait Read {
    fn read_u8(&mut self) -> Result<u8, MessageReadError>;

    fn read_u16<B: ByteOrder>(&mut self) -> Result<u16, MessageReadError> {
        let mut buffer = [0; 2];
        self.read_exact(&mut buffer)?;
        Ok(B::read_u16(&buffer))
    }

    fn read_exact(&mut self, buf: &mut [u8]) -> Result<(), MessageReadError> {
        for i in 0..buf.len() {
            buf[i] = self.read_u8()?;
        }

        Ok(())
    }
}

impl<R: embedded_hal::serial::Read<u8>> Read for R {
    fn read_u8(&mut self) -> Result<u8, MessageReadError> {
        nb::block!(self.read()).map_err(|_| MessageReadError::Io)
    }
}

/// Replacement for std::io::Write + byteorder::WriteBytesExt in no_std envs
pub trait Write {
    fn write_all(&mut self, buf: &[u8]) -> Result<(), MessageWriteError>;

    fn write_u16<B: ByteOrder>(&mut self, n: u16) -> Result<(), MessageWriteError> {
        let mut buffer = [0; 2];
        B::write_u16(&mut buffer, n);
        self.write_all(&buffer)
    }
}

impl<W: embedded_hal::serial::Write<u8>> Write for W {
    fn write_all(&mut self, buf: &[u8]) -> Result<(), MessageWriteError> {
        for i in 0..buf.len() {
            nb::block!(self.write(buf[i])).map_err(|_| MessageWriteError::Io)?;
        }

        Ok(())
    }
}