周晓农1. 项目概述：PX4与ROS的Offboard控制实战
作为一名在无人机领域摸爬滚打多年的开发者，我深知PX4飞控与ROS的结合对于实现高级自主飞行的重要性。这个项目将带你从零开始构建一个完整的Offboard控制系统，让无人机能够执行预设轨迹的自主飞行。
1.1 为什么选择PX4+ROS组合
PX4作为目前最成熟的开源飞控之一，提供了稳定可靠的低层飞行控制能力。而ROS（机器人操作系统）则为我们提供了强大的算法开发框架和丰富的工具链。两者的结合就像给无人机装上了"大脑"和"小脑"：
- PX4负责底层的姿态稳定、传感器融合和执行器控制（小脑功能）
- ROS负责高级的路径规划、决策控制和环境感知（大脑功能）
这种分工明确的架构，使得开发者可以专注于算法实现，而不必担心底层的飞行稳定性问题。
1.2 Offboard控制的本质
Offboard模式是PX4提供的一种特殊飞行模式，它允许外部系统（如运行ROS的机载计算机）直接向飞控发送控制指令。与自动模式（AUTO）不同，Offboard模式需要外部系统持续发送控制指令（至少10Hz），一旦指令流中断，飞控会自动切换到预设的安全模式。
这种模式特别适合需要实时响应的应用场景，比如：
- 基于视觉的物体跟踪
- 复杂环境下的避障导航
- 多机协同编队飞行
- 精确轨迹跟踪（如本文实现的圆形、方形和螺旋轨迹）
需要模型API调用？ 免费领10W Token，多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. PX4飞行模式深度解析
2.1 飞行模式层级结构
PX4的飞行模式可以看作一个控制权限逐级递增的层级结构，理解这个结构对于安全开发至关重要：
-
手动模式（MANUAL/STABILIZED/ACRO）
- 特点：纯手动控制，飞控仅保持基本姿态稳定
- 适用场景：紧急接管、特技飞行
- 限制：无位置或高度保持功能
-
定高模式（ALTCTL）
- 特点：保持高度稳定，水平方向仍需手动控制
- 适用场景：室内飞行或无GPS环境
- 控制方式：油门杆控制升降速率
-
位置模式（POSCTL）
- 特点：全自主位置和高度保持
- 适用场景：常规飞行、Offboard模式前的准备
- 控制方式：摇杆控制速度，松杆即停
-
自动模式（AUTO）
- 包括任务模式（MISSION）、返航（RTL）、起飞（TAKEOFF）等
- 特点：执行预设任务，无需持续外部指令
- 适用场景：预设航点飞行
-
Offboard模式
- 特点：完全由外部系统控制
- 适用场景：高级自主飞行
- 要求：持续10Hz以上的控制指令
2.2 Offboard模式的工作原理
Offboard模式的核心机制是MAVLink协议通信。当切换到Offboard模式后：
- 飞控会检查是否收到有效的设定点消息（如位置、速度或姿态）
- 如果连续0.5秒（默认）没有收到新指令，触发失效保护
- 飞控自动切换到预设的安全模式（通常为位置模式或返航模式）
重要提示：Offboard模式需要先在其他模式（如位置模式）下解锁和起飞，然后再切换到Offboard模式。直接尝试在Offboard模式下解锁会导致失败。
3. ROS控制架构设计
3.1 系统整体架构
我们的Offboard控制系统采用模块化设计，主要包含以下组件：
- MAVROS节点：负责PX4与ROS之间的通信桥梁
- 轨迹生成器：计算预设轨迹的点序列
- 状态机控制器：管理飞行状态的转换
- 控制指令发布器：根据当前状态发布相应指令
3.2 核心通信接口
通过MAVROS，我们可以访问PX4的以下关键接口：
-
模式控制服务
bash复制rosservice call /mavros/set_mode "base_mode: 0 custom_mode: 'OFFBOARD'" -
解锁/上锁服务
bash复制rosservice call /mavros/cmd/arming "value: true" -
位置设定点话题
cpp复制geometry_msgs::PoseStamped pose; pose.pose.position.x = 1.0; pose.pose.position.y = 2.0; pose.pose.position.z = 3.0; local_pos_pub.publish(pose); -
速度设定点话题
cpp复制geometry_msgs::TwistStamped vel; vel.twist.linear.x = 0.5; vel.