从QGC到代码：掌握MAVROS command_long指令的两种高效方式
第一次在QGC界面上点击"Go to location"按钮时，我就被这种简洁的交互方式吸引了。但作为一名开发者，很快发现重复的手动操作不仅效率低下，更无法满足自动化测试和复杂飞行的需求。这就是为什么我们需要深入了解MAVROS的command_long指令——它让我们能够用代码和命令行直接与飞控对话。
1. 理解command_long：无人机控制的底层语言
command_long是MAVLink协议中最常用的消息类型之一，它就像一个万能信封，可以封装各种具体的飞行指令（MAV_CMD）。当你在QGC上点击解锁、起飞或指点飞行时，背后都是通过command_long消息实现的。
1.1 command_long的核心结构
这个指令包含几个关键字段：
{ "target_system": 1, # 目标系统ID "target_component": 1, # 目标组件ID "command": 192, # MAV_CMD指令ID "confirmation": 0, # 确认标志 "param1": 0.0, # 参数1 "param2": 0.0, # 参数2 "param3": 0.0, # 参数3 "param4": 0.0, # 参数4 "param5": 47.398621, # 参数5（纬度） "param6": 8.547745, # 参数6（经度） "param7": 10.0 # 参数7（高度） }表：常见MAV_CMD指令及用途
| 指令ID | 名称 | 用途 | 关键参数 |
|---|---|---|---|
| 400 | MAV_CMD_COMPONENT_ARM_DISARM | 解锁/锁定飞控 | param1: 1=解锁, 0=锁定 |
| 192 | MAV_CMD_DO_REPOSITION | 指点飞行 | param5-7: 纬度,经度,高度 |
| 511 | MAV_CMD_SET_MESSAGE_INTERVAL | 设置消息频率 | param1: 消息ID, param2: 间隔(μs) |
1.2 为什么需要掌握代码方式发送指令
在开发过程中，我逐渐发现了三种典型场景必须使用代码控制：
- 自动化测试：需要批量执行一系列飞行指令并验证结果
- 复杂任务：实现QGC无法提供的定制化飞行逻辑
- 系统集成：将无人机控制嵌入到更大的应用系统中
2. Python脚本方式：灵活可控的编程接口
对于需要复杂逻辑或集成到大型系统中的场景，Python脚本是最佳选择。MAVROS提供了/mavros/cmd/command服务接口，让我们可以方便地发送command_long消息。
2.1 搭建基础环境
在开始编码前，确保你的环境已经准备好：
- 安装ROS和MAVROS包
- 配置好PX4仿真环境
- 启动Gazebo仿真和QGC地面站
提示：可以使用
roslaunch px4 mavros_posix_sitl.launch启动基础仿真环境
2.2 编写指点飞行脚本
下面是一个完整的Python示例，实现与QGC"Go to location"相同的功能：
#!/usr/bin/env python import rospy from mavros_msgs.srv import CommandLong def send_reposition_command(): rospy.wait_for_service('/mavros/cmd/command') try: # 创建服务代理 send_command = rospy.ServiceProxy('/mavros/cmd/command', CommandLong) # 构建指令 command = CommandLong() command.command = 192 # MAV_CMD_DO_REPOSITION command.confirmation = 0 command.param5 = 47.398621 # 纬度 command.param6 = 8.547745 # 经度 command.param7 = 10.0 # 高度(米) # 发送指令 response = send_command( command.broadcast, command.command, command.confirmation, command.param1, command.param2, command.param3, command.param4, command.param5, command.param6, command.param7 ) rospy.loginfo("指令发送成功: %s", response) except rospy.ServiceException as e: rospy.logerr("服务调用失败: %s", e) if __name__ == '__main__': rospy.init_node('send_reposition_command') send_reposition_command()2.3 Python方式的优势与局限
优势：
- 可集成复杂业务逻辑
- 支持错误处理和重试机制
- 便于版本控制和团队协作
局限：
- 需要编写和调试代码
- 启动时间比命令行稍长
3. mavcmd命令行方式：快速调试的利器
当需要快速测试某个指令或进行简单调试时，mavcmd命令行工具提供了更轻量级的解决方案。
3.1 基本命令结构
mavcmd发送command_long指令的基本格式为：
rosrun mavros mavcmd long <command> <param1> <param2> <param3> <param4> <param5> <param6> <param7>3.2 实现指点飞行
与前面Python示例相同的功能，用命令行只需一条指令：
rosrun mavros mavcmd long 192 0 0 0 0 47.398621 8.547745 103.3 设置IMU输出频率
另一个实用场景是调整IMU数据发布频率，这对视觉惯性导航系统(VINS)尤为重要：
rosrun mavros mavcmd long 511 105 5000 0 0 0 0 0这条命令将HIGHRES_IMU(105)消息的发布间隔设置为5000微秒(200Hz)。
3.4 命令行方式的适用场景
- 快速测试单个指令
- 在资源受限的设备上操作
- 需要即时反馈的调试过程
4. 实战技巧与常见问题
在实际项目中，我积累了一些宝贵经验，能帮你避开不少坑。
4.1 参数单位与坐标系
最容易出错的是参数的单位和坐标系：
- 经纬度：使用WGS84坐标系，经度范围[-180,180]，纬度范围[-90,90]
- 高度：通常为相对高度，单位米
- 偏航角：弧度制，0表示正北方向
4.2 confirmation参数的正确使用
关于confirmation参数，经过多次测试发现：
- 设置为0时，飞控不会发送执行确认
- 设置为1时，会收到COMMAND_ACK消息
- 对于关键指令，建议设置为1以便监控执行状态
4.3 调试技巧
当指令不生效时，可以按以下步骤排查：
- 检查
rostopic echo /mavros/state确保MAVROS连接正常 - 使用
rostopic echo /mavros/command/ack查看指令确认 - 在QGC的MAVLink Inspector中检查消息是否送达
4.4 性能优化建议
- 对于高频指令，使用命令行方式延迟更低
- 批量指令建议使用Python脚本，可加入适当的延时
- 关键指令建议添加重试逻辑
)
