mavlink 0.18.0

Implements the MAVLink data interchange format for UAVs.
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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139

mod test_shared;

#[cfg(all(feature = "std", feature = "transport-tcp", feature = "dialect-common"))]
mod test_tcp_connections {
    use std::thread;

    #[cfg(feature = "mav2-message-signing")]
    use crate::test_shared;
    #[cfg(feature = "mav2-message-signing")]
    use mavlink::SigningConfig;
    use mavlink::{MavConnection, MessageData};

    /// Test whether we can send a message via TCP and receive it OK. This also test signing as a property of a MavConnection if the mav2-message-signing feature is enabled.
    #[test]
    fn test_tcp_loopback() {
        const RECEIVE_CHECK_COUNT: i32 = 5;

        #[cfg(feature = "mav2-message-signing")]
        let singing_cfg_server = SigningConfig::new(test_shared::SECRET_KEY, 0, true, false);
        #[cfg(feature = "mav2-message-signing")]
        let singing_cfg_client = singing_cfg_server.clone();

        let server_thread = thread::spawn(move || {
            //TODO consider using get_available_port to use a random port
            #[allow(unused_mut)]
            let mut server =
                mavlink::connect("tcpin:0.0.0.0:14550").expect("Couldn't create server");

            #[cfg(feature = "mav2-message-signing")]
            server.setup_signing(Some(singing_cfg_server));

            let mut recv_count = 0;
            for _i in 0..RECEIVE_CHECK_COUNT {
                match server.recv() {
                    Ok((_header, msg)) => {
                        if let mavlink::dialects::common::MavMessage::HEARTBEAT(_heartbeat_msg) =
                            msg
                        {
                            recv_count += 1;
                        } else {
                            // one message parse failure fails the test
                            break;
                        }
                    }
                    Err(..) => {
                        // one message read failure fails the test
                        break;
                    }
                }
            }
            assert_eq!(recv_count, RECEIVE_CHECK_COUNT);
        });

        // Give some time for the server to connect
        thread::sleep(std::time::Duration::from_millis(100));

        // have the client send a few hearbeats
        thread::spawn(move || {
            let msg = mavlink::dialects::common::MavMessage::HEARTBEAT(
                crate::test_shared::get_heartbeat_msg(),
            );
            #[allow(unused_mut)]
            let mut client =
                mavlink::connect("tcpout:127.0.0.1:14550").expect("Couldn't create client");

            #[cfg(feature = "mav2-message-signing")]
            client.setup_signing(Some(singing_cfg_client));

            for _i in 0..RECEIVE_CHECK_COUNT {
                client.send_default(&msg).ok();
            }
        });

        server_thread.join().unwrap();
    }

    /// Test whether we can send a message via TCP and receive it OK as a raw message. This also test signing as a property of a MavConnection if the mav2-message-signing feature is enabled.
    #[test]
    fn test_tcp_loopback_recv_raw() {
        const RECEIVE_CHECK_COUNT: i32 = 5;

        #[cfg(feature = "mav2-message-signing")]
        let singing_cfg_server = SigningConfig::new(test_shared::SECRET_KEY, 0, true, false);
        #[cfg(feature = "mav2-message-signing")]
        let singing_cfg_client = singing_cfg_server.clone();

        let server_thread = thread::spawn(move || {
            //TODO consider using get_available_port to use a random port
            #[allow(unused_mut)]
            let mut server =
                mavlink::connect::<mavlink::dialects::common::MavMessage>("tcpin:0.0.0.0:14560")
                    .expect("Couldn't create server");

            #[cfg(feature = "mav2-message-signing")]
            server.setup_signing(Some(singing_cfg_server));

            let mut recv_count = 0;
            for _i in 0..RECEIVE_CHECK_COUNT {
                match server.recv_raw() {
                    Ok(message) => {
                        if message.message_id() == mavlink::dialects::common::HEARTBEAT_DATA::ID {
                            recv_count += 1;
                        } else {
                            // one message parse failure fails the test
                            break;
                        }
                    }
                    Err(..) => {
                        // one message read failure fails the test
                        break;
                    }
                }
            }
            assert_eq!(recv_count, RECEIVE_CHECK_COUNT);
        });

        // Give some time for the server to connect
        thread::sleep(std::time::Duration::from_millis(100));

        // have the client send a few hearbeats
        thread::spawn(move || {
            let msg = mavlink::dialects::common::MavMessage::HEARTBEAT(
                crate::test_shared::get_heartbeat_msg(),
            );
            #[allow(unused_mut)]
            let mut client =
                mavlink::connect("tcpout:127.0.0.1:14560").expect("Couldn't create client");

            #[cfg(feature = "mav2-message-signing")]
            client.setup_signing(Some(singing_cfg_client));

            for _i in 0..RECEIVE_CHECK_COUNT {
                client.send_default(&msg).ok();
            }
        });

        server_thread.join().unwrap();
    }
}