MAVLinkMicro Air Vehicle Link是一种轻量级无人机通信协议主要用于飞控、地面站、机载计算机和外围设备之间的数据交换。本章采用 Ubuntu 24.04、PX4 SITL、Gazebo Sim、Python 3 和 Pymavlink 完成 MAVLink 通信实验。Gazebo X500 → PX4 SITL → MAVLink/UDP → Pymavlink Python程序20.1 MAVLink 协议概述MAVLink 不是飞控算法也不是地面站软件而是一套通信规则。它规定消息如何封装、系统和组件如何编号、数据如何校验以及控制命令和状态数据如何传输。20.2 软件安装与环境准备20.2.1 创建虚拟环境并安装 Pymavlink终端前出现 (venv) 表示虚拟环境已激活。截图中 Pymavlink、lxml 和 fastcrc 均已成功安装。图20-1 Pymavlink 安装完成20.2.2 安装基础开发工具截图中各软件均显示已安装或已经是最新版本。图20-2 基础开发工具安装与检查20.2.3 下载或检查 PX4-Autopilot 源码出现 boards、src、Tools、Makefile 和 CMakeLists.txt 等内容说明源码目录存在。图20-3 PX4-Autopilot 源码与目录检查20.2.4 安装 PX4 开发环境与 Gazebo安装脚本会配置 PX4 编译依赖和 Gazebo 仿真环境。截图中 Gazebo Harmonic、OpenCV 和相关开发库均已安装。图20-4 PX4 开发环境与 Gazebo 安装完成20.2.5 启动 PX4 SITL 与 Gazebo X500成功时Gazebo 中出现 X500 四旋翼实体树中出现 x500_0PX4 终端启动 MAVLink、日志和仿真模块。图20-5 PX4 SITL 与 Gazebo X500 仿真启动20.2.6 验证 Pymavlink 与 MAVLink v2 消息库实验中 Pymavlink 版本为 2.4.49MAVLink v2 方言能够正常加载。图20-6 Pymavlink 与 MAVLink v2 消息库验证20.3 PX4 MAVLink 通信链路在 PX4 的 pxh 终端中输入以下命令mavlink status该命令用于查看 MAVLink 实例、模式、协议版本、UDP 端口、发送速率和丢包率。截图中可以看到 MAVLink version 2、UDP、Onboard 和 Gimbal 等链路信息。图20-7 PX4 MAVLink 通信链路状态20.4 HEARTBEAT 心跳消息实验HEARTBEAT 的消息 ID 为 0用于表明系统或组件在线同时携带飞行器类型、自动驾驶仪类型、模式和系统状态。实验结果显示系统ID为1、组件ID为1、飞行器类型为四旋翼、自动驾驶仪为 PX4并能够持续接收心跳。图20-8 Pymavlink 接收 PX4 HEARTBEAT 心跳消息20.5 常用 MAVLink 消息接收实验成功接收到本地位置、速度、姿态、电池和系统状态。截图中电池电压为16.20 V剩余电量为100%。图20-9 常用 MAVLink 消息接收结果20.6 MAVLink v2 帧结构与 CRC 校验解析结果显示 STX 为0xFD、消息ID为0、帧内CRC与计算CRC均为0xFA7ECRC一致为True。图20-10 MAVLink v2 数据帧与 CRC 解析结果20.7 常用消息 ID 与 MAV\_CMDMAVLink 使用消息ID区分 HEARTBEAT、姿态、位置、电池和任务消息使用 MAV_CMD 区分航点、返航、起飞、降落和解锁等命令。图20-11 常用 MAVLink 消息、任务消息和 MAV_CMD 编号20.8 心跳连接与断连检测程序记录最近一次收到 HEARTBEAT 的时间。超过设定阈值仍未收到新心跳时将链路判定为断开。本实验超时阈值设置为5秒。程序首先显示 PX4 上线停止 PX4 后等待5秒显示心跳断连。图20-12 MAVLink 心跳连接与断连检测20.9 MAVLink v2 消息签名实验生成了总长度34字节的签名帧不兼容标志为0x01签名标志为True并成功解析13字节签名区域。图20-13 MAVLink v2 签名数据帧测试20.10 本章小结完成基础工具、PX4、Gazebo 和 Pymavlink 环境检查成功启动 PX4 SITL 与 Gazebo X500查看了 PX4 内部 MAVLink v2 UDP 链路成功接收 HEARTBEAT、姿态、位置、GPS 和电池消息完成 MAVLink v2 原始帧解析与 CRC 校验输出常用消息 ID、任务消息 ID 和 MAV_CMD完成心跳连接与断连检测生成并解析带13字节签名区域的 MAVLink v2 数据帧。说明本章仅完成协议理解和仿真通信实验没有向真实无人机发送解锁、起飞或任务控制指令。 【飞控开发实战·⑳】MAVLink协议完全解析：版本对比、帧结构、CRC校验与心跳消息实战
MAVLinkMicro Air Vehicle Link是一种轻量级无人机通信协议主要用于飞控、地面站、机载计算机和外围设备之间的数据交换。本章采用 Ubuntu 24.04、PX4 SITL、Gazebo Sim、Python 3 和 Pymavlink 完成 MAVLink 通信实验。Gazebo X500 → PX4 SITL → MAVLink/UDP → Pymavlink Python程序20.1 MAVLink 协议概述MAVLink 不是飞控算法也不是地面站软件而是一套通信规则。它规定消息如何封装、系统和组件如何编号、数据如何校验以及控制命令和状态数据如何传输。20.2 软件安装与环境准备20.2.1 创建虚拟环境并安装 Pymavlink终端前出现 (venv) 表示虚拟环境已激活。截图中 Pymavlink、lxml 和 fastcrc 均已成功安装。图20-1 Pymavlink 安装完成20.2.2 安装基础开发工具截图中各软件均显示已安装或已经是最新版本。图20-2 基础开发工具安装与检查20.2.3 下载或检查 PX4-Autopilot 源码出现 boards、src、Tools、Makefile 和 CMakeLists.txt 等内容说明源码目录存在。图20-3 PX4-Autopilot 源码与目录检查20.2.4 安装 PX4 开发环境与 Gazebo安装脚本会配置 PX4 编译依赖和 Gazebo 仿真环境。截图中 Gazebo Harmonic、OpenCV 和相关开发库均已安装。图20-4 PX4 开发环境与 Gazebo 安装完成20.2.5 启动 PX4 SITL 与 Gazebo X500成功时Gazebo 中出现 X500 四旋翼实体树中出现 x500_0PX4 终端启动 MAVLink、日志和仿真模块。图20-5 PX4 SITL 与 Gazebo X500 仿真启动20.2.6 验证 Pymavlink 与 MAVLink v2 消息库实验中 Pymavlink 版本为 2.4.49MAVLink v2 方言能够正常加载。图20-6 Pymavlink 与 MAVLink v2 消息库验证20.3 PX4 MAVLink 通信链路在 PX4 的 pxh 终端中输入以下命令mavlink status该命令用于查看 MAVLink 实例、模式、协议版本、UDP 端口、发送速率和丢包率。截图中可以看到 MAVLink version 2、UDP、Onboard 和 Gimbal 等链路信息。图20-7 PX4 MAVLink 通信链路状态20.4 HEARTBEAT 心跳消息实验HEARTBEAT 的消息 ID 为 0用于表明系统或组件在线同时携带飞行器类型、自动驾驶仪类型、模式和系统状态。实验结果显示系统ID为1、组件ID为1、飞行器类型为四旋翼、自动驾驶仪为 PX4并能够持续接收心跳。图20-8 Pymavlink 接收 PX4 HEARTBEAT 心跳消息20.5 常用 MAVLink 消息接收实验成功接收到本地位置、速度、姿态、电池和系统状态。截图中电池电压为16.20 V剩余电量为100%。图20-9 常用 MAVLink 消息接收结果20.6 MAVLink v2 帧结构与 CRC 校验解析结果显示 STX 为0xFD、消息ID为0、帧内CRC与计算CRC均为0xFA7ECRC一致为True。图20-10 MAVLink v2 数据帧与 CRC 解析结果20.7 常用消息 ID 与 MAV\_CMDMAVLink 使用消息ID区分 HEARTBEAT、姿态、位置、电池和任务消息使用 MAV_CMD 区分航点、返航、起飞、降落和解锁等命令。图20-11 常用 MAVLink 消息、任务消息和 MAV_CMD 编号20.8 心跳连接与断连检测程序记录最近一次收到 HEARTBEAT 的时间。超过设定阈值仍未收到新心跳时将链路判定为断开。本实验超时阈值设置为5秒。程序首先显示 PX4 上线停止 PX4 后等待5秒显示心跳断连。图20-12 MAVLink 心跳连接与断连检测20.9 MAVLink v2 消息签名实验生成了总长度34字节的签名帧不兼容标志为0x01签名标志为True并成功解析13字节签名区域。图20-13 MAVLink v2 签名数据帧测试20.10 本章小结完成基础工具、PX4、Gazebo 和 Pymavlink 环境检查成功启动 PX4 SITL 与 Gazebo X500查看了 PX4 内部 MAVLink v2 UDP 链路成功接收 HEARTBEAT、姿态、位置、GPS 和电池消息完成 MAVLink v2 原始帧解析与 CRC 校验输出常用消息 ID、任务消息 ID 和 MAV_CMD完成心跳连接与断连检测生成并解析带13字节签名区域的 MAVLink v2 数据帧。说明本章仅完成协议理解和仿真通信实验没有向真实无人机发送解锁、起飞或任务控制指令。