The better mavlink library.
Libmav is a library for interacting with mavlink systems. It provides message serialization / deserialization, code to interact with physical networks and several of the mavlink internal protocols.
There are many mavlink libraries out there. The main advantages of this library over others are:
- Runtime defined message set. No need to recompile on message set change
- Native python bindings for C++ code. Faster than pure python. Coming soon
- Header-only, no dependencies, C++ 17, >90% test coverage
There are several ways to get it:
Install globally on your system
cmake .
sudo make install
Since the library is header only, you only need the library on the build system.
You can also include the library as a submodule in your project.
In libmav, the message set is runtime defined and loaded from XML files. Any of the upstream XML files will work. The function also loads dependent XML files recursively.
auto message_set = libmav::MessageSet("/path/to/common.xml");
You can also extend a loaded message set with additional XML files or inline XML:
message_set.addFromXMLString(R""""(
<mavlink>
<messages>
<message id="9912" name="TEMPERATURE_MEASUREMENT">
<field type="float" name="temperature">The measured temperature in degress C</field>
</message>
</messages>
</mavlink>
)"""");
From the message set, you can instantiate and populate a message like so
auto message = message_set.create("PARAM_REQUEST_READ");
message["target_system"] = 1;
message["target_component"] = 1;
message["param_id"] = "SYS_AUTOSTART";
message["param_index"] = -1;
Alternatively you can also use an initializer list notation
message.set({
{"target_system", 1},
{"target_component", 1},
{"param_id", "SYS_AUTOSTART"},
{"param_index", -1}
});
Libmav has classes for the following protocols:
- Serial
- TCP Client
- TCP Server Coming soon
- UDP Client
- UDP Server
Libmav does not do any threading, except for the NetworkRuntime
class.
The NetworkRuntime
class spawns a two threads. One two drive the receive
loop and one to drive the HEARTBEAT transmission and timeout handling.
// Create interface for physical network
auto physical = libmav::TCPClient("<ip>", 14550);
auto heartbeat_message = message_set.create("HEARTBEAT");
heartbeat_message.set({
{"type", message_set.e("MAV_TYPE_GCS")},
{"autopilot", message_set.e("MAV_AUTOPILOT_GENERIC")},
{"base_mode", 0},
{"custom_mode", 0},
{"system_status", message_set.e("MAV_STATE_ACTIVE")},
{"mavlink_version", 2}
});
// Create a network runtime with
// This runtime will automatically send out HEARTBEAT messages, iff a HEARTBEAT
// message is defined here
auto runtime = libmav::NetworkRuntime(
message_set, heartbeat_message, physical);
// You can change the heartbeat message any time by calling
// setHeartbeatMessage on the runtime. Also you can clear
// the heartbeat at any time by calling clearHeartbeat
// Wait for the connection (as defined as we
// receive some mavlink from the other end), with a 2s timeout
auto connection = runtime.awaitConnection(2000);
// Check if connection is still alive
if (connection->alive()) {
// Do something with the connection
}
// Create interface for physical network
auto physical = libmav::UDPServer(14559);
// Create a network runtime with
// This runtime will not automatically send HEARTBEAT messages
auto runtime = libmav::NetworkRuntime(message_set, physical);
// Handle incoming connections
runtime.onConnection([](std::shared_ptr<mav::Connection> connection) {
// Do something with the connection
});
runtime.onConnectionLost([](std::shared_ptr<mav::Connection> connection) {
// Do something when a connection drops
});
The classes will throw libmav::NetworkError
if connection fails.
The easiest way to send receive messages is using the synchronous API:
// create a message
auto message = message_set.create("PARAM_REQUEST_READ") ({
{"target_system", 1},
{"target_system", 1},
{"param_id", "SYS_AUTOSTART"},
{"param_index", -1}
});
// send a message
conection.send(message);
// ⚠️ Potential race condition here! (read below)
// receive a message, with a 1s timeout
auto response = connection.receive("PARAM_VALUE", 1000);
The call to receive is blocking. Note that the code above has a potential race condition. To start receiving for a response before the request goes out, you can do this:
// create a message
auto message = message_set.create("PARAM_REQUEST_READ") ({
{"target_system", 1},
{"target_system", 1},
{"param_id", "SYS_AUTOSTART"},
{"param_index", -1}
});
// Already watch for the answer
auto expectation = connection.expect("PARAM_VALUE");
// send the message
conection.send(message);
// Wait for the answer, with a 1s timeout
auto response = connection.receive(expecation, 1000);
Alternatively, you can also register regular callbacks
// adding a callback
auto callback_handle = connection.addMessageCallback(
[](const libmav::Message& message) {
std::cout << message.name() << std::endl;
});
// adding a callback with an error handler
auto callback_handle = connection.addMessageCallback(
[](const libmav::Message& message) {
std::cout << message.name() << std::endl;
},
[](const std::exception_ptr& exception) {
std::cout << "Exception" << std::endl;
});
// removing a callback
connection.removeMessageCallback(callback_handle);