2. MAVLink协议入门

好，咱们正式开始啃MAVLink这块硬骨头。

说实话，我第一次接触MAVLink的时候，看着那一堆十六进制数据，头都是大的。后来在PX4飞控项目里调了整整一周的串口数据，才真正摸清楚它的脾气。今天我就把那些踩过的坑和总结出来的经验，一次性讲给你听。

2.1 MAVLink协议简介

MAVLink，全称Micro Air Vehicle Link，是无人机领域最主流的通信协议。说白了，它就是一套约定好的“暗号”，让飞控、地面站、摄像头、机械臂这些设备能互相听懂对方在说什么。

目前主流版本有两个：v1.0 和 v2.0。v2.0兼容v1.0，但增加了签名机制，安全性更好。我个人建议，新项目直接上v2.0，别犹豫。

核心特点：

  • 轻量级：v1.0消息头只有8字节，v2.0也只有12字节。在带宽有限的数传链路上，这很关键。
  • 高可靠性：每帧都带CRC16校验，丢包或错包能立刻发现。
  • 可扩展：消息ID从0到255（v1.0），你可以自定义消息。

2.2 消息类型与ID

MAVLink里所有的通信内容，都叫“消息”。每条消息都有一个唯一的消息ID，就像每个人的身份证号。

我习惯把常用消息分成几类，这样查起来方便：

消息ID 消息名称 说明 我在项目中遇到过
0 HEARTBEAT 心跳包，每秒1-2Hz，告诉对方“我还活着” 地面站断连，十有八九是心跳丢了
24 GPS_RAW_INT GPS原始数据（经纬度、海拔、速度） 经纬度单位是1e7度，别直接当double用
30 ATTITUDE 姿态数据（横滚、俯仰、偏航） 单位是弧度，不是角度！
65 RC_CHANNELS 遥控器通道值 PWM值范围是1000-2000，不是0-255
74 VFR_HUD 飞行状态（空速、地速、高度） 空速和地速不一样，逆风时差别很大

小技巧： 调试时，先抓HEARTBEAT。如果心跳通了，说明链路层没问题。我曾经花了两小时查数据解析错误，最后发现是串口波特率配错了——心跳包根本就没发出来。

2.3 消息包结构解析

这是今天的重头戏。咱们直接看v2.0的消息包结构，因为v1.0基本可以看作是它的子集。

一个完整的MAVLink v2.0帧，长这样：

+------+------+------+------+------+------+------+------+------+------+------+------+------+------+------+------+
|  STX | LEN  | INC  | CMP  | SEQ  | SYS  | COMP | MSG ID (3字节)  | PAYLOAD (0-255字节) | CRC16 (2字节) |
| 0xFD |      | FLG  | FLG  |      | ID   | ID   |                 |                      |               |
+------+------+------+------+------+------+------+------+------+------+------+------+------+------+------+------+

咱们拆开来看每个字段：

  1. STX (起始标志)：固定0xFD，表示这是一个v2.0帧。v1.0是0xFE。收到0xFD，就知道该按v2.0解析了。
  2. LEN (负载长度)：PAYLOAD部分的字节数，范围0-255。
  3. INC FLG (不兼容标志)：如果某位为1，接收方不理解这个标志就必须丢弃整帧。比如加密位。
  4. CMP FLG (兼容标志)：如果某位为1，接收方不理解可以忽略，继续处理。
  5. SEQ (序列号)：每发一帧加1，用来检测丢包。范围0-255，循环使用。
  6. SYS ID (系统ID)：标识是哪个设备，比如飞控是1，地面站是255。
  7. COMP ID (组件ID)：标识设备里的哪个组件，比如飞控的自动驾驶仪是1，摄像头是100。
  8. MSG ID (消息ID)：3字节，范围0-16777215。这就是咱们前面说的“身份证号”。
  9. PAYLOAD (负载)：实际数据，长度由LEN决定。
  10. CRC16 (校验)：对整个帧（从LEN开始到PAYLOAD结束）做CRC16校验，确保数据没被篡改。

注意： CRC16的计算范围不包括STX。而且v2.0的CRC计算还要额外加上消息ID的低16位。这个坑我踩过——自己写的解析库，CRC怎么都对不上，查了半天才发现是漏了消息ID。

2.4 知识体系总览

为了让你对MAVLink有个整体印象，我画了张图。你可以把它当作本章的“地图”：

MAVLink协议知识体系 MAVLink协议 协议简介 消息类型与ID 消息包结构 v1.0 vs v2.0 轻量级/可靠 HEARTBEAT GPS_RAW_INT ATTITUDE 帧头解析 CRC校验 负载解析 💡 学习路径建议 先理解帧结构 → 抓包看HEARTBEAT → 解析GPS/姿态数据 → 自己写解析器

2.5 实战：手撕一个HEARTBEAT包

光说不练假把式。咱们拿一个真实的HEARTBEAT包来解析一下。

假设串口收到这么一串数据（十六进制）：

FD 09 00 00 01 01 01 00 00 00 00 00 00 00 00 00 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03 03
        

            ← 上一章
            📖 返回目录
            下一章 →