4、MAVLink协议详解：消息格式、常见消息（HEARTBEAT、ATTITUDE、LOCAL_POSITION_NED）、QGC与MAVLink调试
MAVLink（Micro Air Vehicle Link）是PX4、ArduPilot等开源飞控与地面站、机载计算机之间通信的事实标准协议。它采用轻量级消息封装，以字节流形式在串口、UDP、TCP或共享内存上传输。理解MAVLink的帧结构、消息语义和调试方法，是进行Offboard模式开发、视觉模型部署和飞控联调的前提。本章将从协议帧格式出发，深入解析三类核心消息，并结合QGroundControl（QGC）演示实际调试流程。
上图展示了MAVLink协议在PX4系统中的三个关键维度：左侧为消息帧的二进制布局，中间为飞控与地面站之间最常交互的几类消息，右侧为QGC提供的调试工具入口。下面我们将逐一展开。
4.1 MAVLink消息格式：从字节流到结构化数据
MAVLink协议目前有两个主要版本：MAVLink 1和MAVLink 2。PX4默认使用MAVLink 2，因为它支持24位消息ID、消息签名和更大的载荷长度。但无论是哪个版本，其帧结构都遵循“起始标志 + 头部 + 载荷 + 校验”的基本模式。
| 字段 | 长度(字节) | 说明 |
|---|---|---|
| STX | 1 | 起始标志，MAVLink 2为0xFD，MAVLink 1为0xFE |
| LEN | 1 | 载荷长度，MAVLink 2中最大255字节 |
| SEQ | 1 | 序列号，用于检测丢包 |
| SYS_ID | 1 | 系统ID，区分不同的飞控或地面站 |
| COMP_ID | 1 | 组件ID，区分同一系统内的不同模块（如自动驾驶仪、相机、Gimbal） |
| MSG_ID | 3 (MAVLink2) | 消息ID，决定载荷的解析方式 |
| PAYLOAD | 0-255 | 消息体，具体内容由MSG_ID决定 |
| CKA/CKB | 2 | CRC校验，MAVLink 2还包含额外的CRC种子 |
在编写Offboard代码时，我们通常不会直接操作这些字节，而是使用官方生成的C++或Python库（如pymavlink）。但理解帧结构有助于排查通信问题，例如当QGC显示“丢包率过高”时，你可以通过检查SEQ字段的连续性来判断是无线链路问题还是串口波特率不匹配。
mavlink start -u 14550 命令启动UDP通信，通过 mavlink status 查看当前活动的MAVLink通道及其数据速率。如果发现某个通道的“RX loss”持续增长，优先检查物理链路和缓冲区大小。
4.2 核心消息详解：HEARTBEAT、ATTITUDE、LOCAL_POSITION_NED
这三类消息是飞控与地面站、机载计算机之间最基础的通信内容。HEARTBEAT用于维持连接状态，ATTITUDE提供姿态信息，LOCAL_POSITION_NED提供位置和速度信息。在Offboard控制中，我们还需要向飞控发送目标位置消息（如SET_POSITION_TARGET_LOCAL_NED），但首先必须正确解析飞控发出的遥测数据。
4.2.1 HEARTBEAT（MSG_ID=0）
HEARTBEAT是MAVLink的“心跳”消息，通常以1Hz频率发送。它包含飞控的类型、自动舵机模式（如OFFBOARD、AUTO、STABILIZED）和自定义模式位。在Offboard开发中，判断飞控是否进入Offboard模式，就是通过解析HEARTBEAT中的base_mode和custom_mode字段。
# pymavlink 解析HEARTBEAT示例
from pymavlink import mavutil
master = mavutil.mavlink_connection('udp:14550')
msg = master.recv_match(type='HEARTBEAT', blocking=True)
print(f"System ID: {msg.sysid}, Mode: {msg.custom_mode}")
# 判断是否进入Offboard模式（PX4的custom_mode为4表示Offboard）
if msg.custom_mode == 4:
print("飞控已进入Offboard模式")4.2.2 ATTITUDE（MSG_ID=30）
ATTITUDE消息以约100-250Hz频率发送，包含飞行器的滚转、俯仰、偏航角（欧拉角）以及对应的角速度。在视觉模型部署中，我们通常需要将视觉检测到的目标位置与飞控姿态进行融合，因此必须同步获取ATTITUDE数据。注意，PX4发送的欧拉角单位是弧度，且遵循Z-Y-X旋转顺序。
4.2.3 LOCAL_POSITION_NED（MSG_ID=32）
该消息以约30-50Hz频率发送，提供飞行器在NED（北东地）坐标系下的位置（x, y, z）和速度（vx, vy, vz）。在Offboard控制中，这是最关键的反馈量。例如，当视觉模型检测到目标在相机坐标系下的偏移后，需要将其转换到NED坐标系，再与LOCAL_POSITION_NED中的当前位置相加，生成目标位置指令。
4.3 QGC与MAVLink调试：从界面到日志
QGroundControl是PX4官方推荐的地面站软件，它内置了多种MAVLink调试工具。在联调过程中，我们主要使用以下三个功能：MAVLink Inspector（实时消息查看）、MAVLink Analyzer（消息频率与延迟分析）以及飞控日志下载。
4.3.1 MAVLink Inspector
在QGC的“分析工具”菜单中可以打开MAVLink Inspector。它会列出所有正在收发的消息，并实时更新消息频率和最新值。例如，你可以观察HEARTBEAT是否以1Hz稳定到达，ATTITUDE的roll/pitch/yaw值是否随无人机倾斜而变化。如果Inspector中长时间看不到某条消息，说明飞控未发送该消息或通信链路存在过滤。
4.3.2 MAVLink Analyzer
这是一个更专业的插件，可以绘制消息频率随时间变化的曲线，并计算端到端延迟。在Offboard联调中，如果发现SET_POSITION_TARGET_LOCAL_NED消息的发送频率低于10Hz，飞控会因“Offboard模式丢失”而自动退出，此时Analyzer能帮助你快速定位是代码发送频率不足，还是串口/UDP传输存在瓶颈。
4.3.3 飞控日志（ULog）
当问题难以在实时调试中复现时，下载飞控SD卡中的ULog文件进行离线分析是标准做法。在QGC中点击“分析工具”->“日志下载”，即可获取最近的飞行日志。使用PX4官方工具 ulog2csv 可以将日志转换为CSV格式，然后用Python或Excel分析。
4.4 案例拆解：一次典型的Offboard联调排障
下面通过一个实际案例，展示如何利用MAVLink调试手段解决Offboard控制失效的问题。
背景与约束：某团队使用树莓派作为机载计算机，通过UDP连接PX4飞控，运行视觉避障程序。飞控固件为PX4 1.13，QGC版本为4.2。在飞行测试中，无人机起飞后约10秒突然退出Offboard模式，进入降落模式。
初始现象：QGC的MAVLink Inspector显示，飞控在退出Offboard前约2秒，LOCAL_POSITION_NED消息的接收频率从30Hz骤降至5Hz，随后HEARTBEAT的custom_mode从4（Offboard）变为3（AUTO）。
分析过程：首先检查机载计算机的发送代码，发现SET_POSITION_TARGET_LOCAL_NED消息以20Hz发送，满足PX4要求的最低10Hz。然后使用MAVLink Analyzer查看UDP链路延迟，发现延迟从平均5ms波动至200ms。进一步检查树莓派的网络状态，发现Wi-Fi信号强度在飞行中从-45dBm降至-70dBm，导致UDP丢包率上升。
实际操作步骤：
- 将树莓派与飞控改为有线连接（使用USB转串口），避免Wi-Fi干扰。
- 在PX4启动脚本中增加
mavlink stream -u 14550 -s LOCAL_POSITION_NED -r 50，提高位置消息的发送频率。 - 在机载计算机代码中增加消息超时判断：若超过500ms未收到LOCAL_POSITION_NED，则停止发送Offboard指令并触发降落。
结果对比：修改后，LOCAL_POSITION_NED频率稳定在50Hz，UDP延迟保持在10ms以内，Offboard模式持续运行至任务结束，未再出现意外退出。
复盘经验：MAVLink调试不能只看消息是否到达，还要关注消息的频率和延迟。在无线环境下，建议使用QGC的“MAVLink Analyzer”记录全程数据，以便事后回溯。此外，PX4的Offboard模式对通信质量非常敏感，任何超过1秒的通信中断都会导致模式退出，因此必须设计鲁棒的超时保护逻辑。
4.5 常见误区与总结
- 误区一：认为MAVLink消息发送频率越高越好。实际上，过高的频率会占用串口带宽，导致其他关键消息（如HEARTBEAT）被延迟。PX4官方建议Offboard指令频率在10-50Hz之间。
- 误区二：忽略消息的坐标系定义。LOCAL_POSITION_NED使用NED坐标系，而视觉模型通常输出相机坐标系或机体坐标系下的数据，转换错误会导致无人机飞向错误方向。
- 误区三：在QGC中修改参数后不重启飞控。部分MAVLink参数（如SYSID_MYCOMP）需要重启才能生效，否则可能导致消息路由异常。