MAVLink笔记 #02# MAVLink绝对傻瓜教程（译）

本文译自Shyam Balasubramanian所写的MavLink Tutorial for Absolute Dummies (Part –I) , 2013。仅供学习交流。
linux

索引

我为你而来，MavLink
MavLink消息的结构：
MavLink究竟是如何工做的
地面控制站（GCS）到四轴飞行器：
四轴飞行器到地面控制站（GCS）到四轴飞行器：

MavLink是什么鬼？它是一种通讯协议。当看到这个概念后，大伙就开始畏惧它。这个教程将迫使你深入地领悟它，并通俗易懂地阐述它到底是什么，它是如何工做的，最重要的是它究竟是如何工做的！！我将试着解释Mission Planner如何与APM/ PX4通讯，反之亦然。这将有助于你的扩展，并激发你潜在的天才程序员天赋，若是你还没激发的话！！git

PS. Mission Planner是一款开源的无人机地面站软件，APM/ PX4则分别为两种飞控固件（相似于windows和linux的关系）。而pixhawk是飞控硬件，它能够安装上述两种固件中的任何一个。程序员

本教程假定：github

你是个小白☹我曾经也是，但如今再也不是了!编程
你至少在C语言方面具有必定的编程技能（例如，在C/C++/C#/Java中编写过简单的switch cases）。若是你已是专业级，那么return 0;windows
你很严肃地打算去学习知识，由于你将为此失去一些睡眠！安全

但无论怎样，请始终保持学习的意愿，我衷心但愿你永远不会忘记这一点🙂我能够开始了吗？数据结构

我为你而来，MavLink

Mavlink消息基本上是由Mission Planner（MP）编码，并经过USB串行或遥测发送到APM的一串字节（二者不能同时使用。若是同时插入，则优先选择USB，而忽略遥测）。这里的编码并无什么特别之处，只是把数据包放入一个数据结构中，而后经过信道以字节的形式发送出去，同时加上一些错误纠正。函数

MavLink消息的结构：

每一个MavLink数据包的长度为17字节，结构以下：工具

消息长度 = 17 (6 bytes header + 9 bytes payload + 2 bytes checksum)

长度为6个字节的首部 header 0. message header, 永远为 0xFE
1. message length (9) 2. sequence number -- 在 255 和 0 之间轮转(0x4e，前一个是 0x4d) 3. System ID - 什么系统在发送这个消息 (1) 4. Component ID- 系统的哪一个组件正在发送消息 (1) 5. Message ID (例如 0 = heartbeat 等等! 别害羞，你也能够添加..) 可变长的有效负载 Payload (由八位组构成, 范围是 0..255) ** Payload (咱们感兴趣的实际数据) 校验和 Checksum: 用于错误检测

PS. “由八位组构成”在原文中是specified in octet 1

（APM以及地面站）软件所作的事情是，检查它是否为一个有效的消息（经过检查Checksum判断消息是否已损坏，丢弃已经损坏的消息）。这是遥测的波特率为何设置为57,600而不是115,200 bps的缘由之一。该数值越低，软件容易发生的错误就越少，虽然消息更新到地面站的速度会慢一些。若是你想在采用MavLink协议的同时取得更远点的距离，进一步下降波特率多是一个好主意。然而，须要注意的是，通过测试，57,600bps在理论上能够经过3DR遥测无线电提供大约一英里半径的覆盖范围。还记得高中时的信噪比（SNIR）的概念吗?

如今，根据上面的内容，咱们感兴趣的东西是：

System ID（亦称消息的来源）：这是指经过无线遥测或USB端口向APM发送消息的发送源（也就是MP），软件会按期进行检查，以确认消息是发送给它的。
Component ID （亦称系统中的子系统）：主系统中的任何子系统。目前，这里并无子系统，咱们也没有真正利用这个字段。
Message ID：标识这是条关于什么的信息。在本教程中，咱们将其称为“主消息（main message）”。
Payload（实际数据）：这就是肉！这就是你想要的！！

MavLink究竟是如何工做的

MavLink啥也不是就是一条消息。MavLink也能够用于地面机器人，因此微型飞行器链路（Micro Aerial Vehicle Link，也就是MavLink）并非一个十分贴切的名字。之因此采起这种方式命名呢，是由于它起始于直升机（若是我没猜错的话）。

“消息”是一个包含“常量字节数”（如前所述，即17字节）的数据包。APM（从空中）获取流字节，将其传输到硬件接口（例如，经过UART或遥测），并在软件中对消息进行解码。注意，消息包含着咱们即将提取的有效负载（payload）。

咱们对有效负载很感兴趣，可是，嘿，和有效负载在一块儿的是Message ID（见上面），咱们能够经过它了解有效负载表明着什么。在这以前，先看看程序解释一切MavLink消息的几个步骤：

咱们有一个名为handlemessage (msg)的方法。这个就是你须要学习和了解的方法！在GCS_MavLink.pde中找到它（在Arducopter/ ArduPlane里）。

PS. 该方法隶属APM固件的源代码。GCS_MavLink.pde如今彷佛是这个https://github.com/ArduPilot/ardupilot/blob/8f550ffdd48a3165c115ca24d6ce5227a5f826d1/ArduCopter/GCS_Mavlink.cpp

它基本上是在问信息包：嘿，你是谁？你是为我而来仍是试图侵入个人系统？在我给予你许可以前，让我先读一下你的系统ID和组件ID。任何使用MavLink的系统都有一个系统ID和组件ID。例如，你的MP和正在飞行的四轴飞行器将具备相同的系统ID。组件ID则用于附加到APM/PX4的“子系统”。

注意：当前，系统ID和组件ID被硬编码为相同的。

如今，你仅有一个遥测和一架安装了APM的直升机，就是这样，去愉快地飞行吧-不用再考虑其它的！这些东西对多直升机有帮助（在将来），将来将会有不一样的系统ID🙂
咱们从消息中提取有效负载并放入一个包（packet）中。包是基于一种“信息类型”的数据结构。咱们将再也不使用“消息”一词，那玩意儿到这里就结束了。咱们基本上只对由“原始数据”打包而成的包感兴趣。
包被放入一个“适当的数据结构”中。有许多数据结构，例如用来存放姿态（俯仰，横摇，偏航方向）的、GPS的、无线电控制信道的，等等，也就是，把类似的东西组合在一块儿，造成易于理解的模块。这些数据结构在发送端和接收端（即在MP端和APM端）“100%彻底相同”。若是不同的话，你的直升机就会在奇怪的时间坠毁！

PS. 无线电控制信道原文中为RC channel

此外，这也是MavLink GUI生成器大展身手的地方。为了生成这些数据结构，咱们不须要编写任何代码！！嗯，也不彻底是，但只有一点点。

到目前为止很简单对不对？若是以为困难请重读一遍！！当个笨蛋不要紧的🙂

好了，如今说正事。咱们使用MavLink发送双向消息。

从地面控制站（GCS）到APM/PX4或从APM/PX4到地面控制站（GCS）。注意，我说的GCS是指Mission Planner（MP）或者QGroundControl（QGC）、DroidPlanner（DP）或者你自定义的与直升机通讯的工具。

地面控制站（GCS）到四轴飞行器：

到目前为止，咱们知道每一个消息（咱们叫一个包，里面有对咱们有用的信息）都有一个消息ID和有效负载，并将其放入适当类型的数据结构中。咱们根据主消息（或MAVLINK_MSG_ID_）进行选择，一旦检测到特定类型的消息，就会执行一些神奇的操做，好比将接收到的信息存储到永久内存中，或者执行咱们但愿对其执行的任何操做。

截至2013年11月，在Arducopter最新的3.0.1 RC5（候选版本）中，如下是你可能看到的参数。我已经试着列出全部可能的MavLink消息的“主消息”ID。

请注意，在每一个“主消息”类别中（如粗体部分下面的东西）你会找到属于那个类别的“子消息”，它们基本上与有效负载信息（真正的肉）及其处理方式密切相关。就像“自行车”类别有雅马哈，铃木，哈雷戴维森等。我列出了全部的主要信息类别，但只指定了一些子类别。你能够本身查一下细节🙂由于若是你明白我到目前为止的意思，你就再也不是个傻瓜了。明白个人意思吗？

PS. 由于下面的部分，准确含义并不太清楚，因此只选了若干个翻译。欲看每一个条目的详情可查看原文：https://diydrones.com/forum/topics/mavlink-tutorial-for-absolute-dummies-part-i?groupUrl=arducopterusergroup

MAVLINK_MSG_ID（主消息块）：

MAVLINK_MSG_ID_HEARTBEAT：//0

这是最重要的信息。GCS不断地向APM/PX4发送信息，以肯定它是否与之相连（每1秒一次）。这是为了确保在更新某些参数时MP与APM是同步的。若是错过了许多心跳信号，则会触发故障保护（可能），接着直升机可能着陆、继续执行任务或返回发射（Returns to launch，也称为RTL）。在MP的“配置/设置故障保护选项”下，能够启用/禁用故障保护选项。但你不能中止心跳，对吗？这个名字颇有道理！!
MAVLINK_MSG_ID_REQUEST_DATA_STREAM：//66

请求传感器，无线电控制信道，GPS位置，状态，Extra 1/2/3 等数据
MAVLINK_MSG_ID_COMMAND_LONG：//76

无限制悬停（Loiter unlimited），RTL，着陆，任务开始（Mission start），飞控解锁/锁定（Arm/Disarm ），从新启动（Reboot）。

PS. 例如在航前检查未经过时是禁止直接用commander arm对飞控解锁的。
SET_MODE： //11

E.g. set_mode(packet.custom_mode);
MAVLINK_MSG_ID_MISSION_REQUEST_LIST： //43
MAVLINK_MSG_ID_MISSION_REQUEST： //40
MAVLINK_MSG_ID_MISSION_ACK： //47
MAVLINK_MSG_ID_PARAM_REQUEST_LIST： //21
MAVLINK_MSG_ID_PARAM_REQUEST_READ： //20
MAVLINK_MSG_ID_MISSION_CLEAR_ALL： //45
MAVLINK_MSG_ID_MISSION_SET_CURRENT： //41
MAVLINK_MSG_ID_MISSION_COUNT： // 44
MAVLINK_MSG_ID_MISSION_WRITE_PARTIAL_LIST： //
MAVLINK_MSG_ID_SET_MAG_OFFSETS： //151
MAVLINK_MSG_ID_MISSION_ITEM： //39
MAVLINK_MSG_ID_PARAM_SET： //23
MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE： //70
MAVLINK_MSG_ID_HIL_STATE： //90
MAVLINK_MSG_ID_DIGICAM_CONFIGURE： //
MAVLINK_MSG_ID_MOUNT_CONFIGURE： //
MAVLINK_MSG_ID_MOUNT_CONTROL： //
MAVLINK_MSG_ID_MOUNT_STATUS：//
MAVLINK_MSG_ID_RADIO, MAVLINK_MSG_ID_RADIO_STATUS： //

四轴飞行器到地面控制站（GCS）到四轴飞行器：

好吧，我认可，这变得更有趣了。但这其实容易得多。事实上，GCS系统只是你和直升机之间的中介物，它反过来从直升机获取数据，并显示在GCS系统上。

若是你打开了Arducopter.pde文件，请查看代码的这一部分：

PS. Arducopter.pde如今彷佛是这个https://github.com/ArduPilot/ardupilot/blob/master/ArduCopter/Copter.cpp

static const AP_Scheduler::Task scheduler_tasks[] PROGMEM = { . . . . . . { gcs_send_heartbeat, 100, 150 }, { update_notify, 2, 100 }, { one_hz_loop, 100, 420 }, { gcs_check_input, 2, 550 }, { gcs_send_heartbeat, 100, 150 }, { gcs_send_deferred, 2, 720 }, { gcs_data_stream_send, 2, 950 }, . . . . . . . . .

别惧怕。这比呼吸还容易。这就是实时系统概念发挥做用的地方。咱们但愿肯定的任务花费肯定的时间，若是到了规定的时间任务仍没完成，就再也不继续执行它们了。

第一个参数是函数名，

第二个是“它应该花费的时间”（以10毫秒为单位，例如2表示20毫秒执行一次，即50赫兹，即该功能每秒运行50次）。

PS. 1s = 1000ms 故 1000 / 20 = 50 ms/次 = 50Hz

第三个参数是“最长执行时间，超出该时间函数就不该继续运行”。

我以为这很简单！你在这里看到的每个函数，它的将来都是肯定的，运行时间都是一成不变的。这就是为何咱们在这些讨厌的机器上采用实时系统，这能够保证它的安全，让其变得可预测而不是不可预测！！

全部这些函数都是为你精心挑选的，以便让你知道它们与GCS系统的更新相关。简单地说，进入每个函数的定义，这些函数将始终能够在GCS_Mavlink.pde中找到，在那里GCS系统通讯的实际操做发生了！!

最有趣（也是最重要）的是：

/* * send data streams in the given rate range on both links */
static void gcs_data_stream_send(void) { gcs0.data_stream_send(); if (gcs3.initialised) { gcs3.data_stream_send(); } }

上面所作的事情是，经过链路发送数据（gcs0表示经过USB，gcs3表示经过遥测）。若是你再深刻一点，你就会知道，咱们会把这些数据结构发送回GCS系统显示。

例如，当你用手移动你的直升机时，瞧瞧MP的HUD屏幕发生了什么？你将看到直升机在屏幕上移动。而且，咱们获得了每一个时间单位的飞行姿态数据（俯仰、横摇和偏航）。一样，咱们还能够看到IMU数据、GPS数据、电池数据等。