不止于起飞降落：用ROS Noetic和MAVROS深度控制PX4仿真无人机
当你已经能让无人机在Gazebo中起飞降落时，真正的挑战才刚刚开始。本文将带你深入ROS Noetic与PX4的通信核心，探索如何通过MAVROS实现高级控制逻辑，让仿真无人机具备真正的"智能"。
1. MAVROS通信架构解析
MAVROS作为ROS与PX4飞控的桥梁，其核心是建立双向通信通道。理解以下关键Topic和Service是深度控制的基础：
关键Topic订阅清单：
/mavros/state- 飞控状态（连接状态、飞行模式等）/mavros/local_position/pose- 本地坐标系下的位置姿态/mavros/global_position/global- 全球定位数据/mavros/battery- 电池状态信息
常用控制Service：
/mavros/cmd/arming- 解锁/锁定电机/mavros/set_mode- 设置飞行模式（如OFFBOARD）/mavros/global_position/set_gp_origin- 设置全局坐标系原点
# 典型Topic订阅示例 import rospy from mavros_msgs.msg import State def state_cb(msg): print(f"Current mode: {msg.mode}, Armed: {msg.armed}") rospy.init_node('mavros_monitor') state_sub = rospy.Subscriber('/mavros/state', State, state_cb)注意：OFFBOARD模式需要持续发送控制指令（>2Hz），否则飞控会自动切换回安全模式
2. 三维空间精确控制实战
超越简单的起飞降落，我们需要掌握三种核心控制方式：
2.1 位置控制
通过/mavros/setpoint_position/local发布目标位置信息。坐标系通常采用ENU（东-北-天）方向：
from geometry_msgs.msg import PoseStamped target = PoseStamped() target.header.stamp = rospy.Time.now() target.pose.position.x = 5.0 # 东向5米 target.pose.position.y = 3.0 # 北向3米 target.pose.position.z = 2.0 # 高度2米2.2 速度控制
使用/mavros/setpoint_velocity/cmd_vel实现平滑移动：
from geometry_msgs.msg import TwistStamped vel_cmd = TwistStamped() vel_cmd.twist.linear.x = 0.5 # 东向0.5m/s vel_cmd.twist.linear.y = -0.2 # 北向-0.2m/s2.3 混合控制策略
结合位置和速度控制的优势：
| 控制方式 | 适用场景 | 精度 | 平滑性 |
|---|---|---|---|
| 纯位置控制 | 精确到达目标点 | 高 | 中等 |
| 纯速度控制 | 连续轨迹跟踪 | 中等 | 高 |
| 混合控制 | 复杂任务 | 可调 | 可调 |
3. 构建完整的控制节点
下面展示一个完整的ROS节点实现，包含状态监控、模式切换和位置控制：
#!/usr/bin/env python import rospy from mavros_msgs.msg import State, PositionTarget from mavros_msgs.srv import SetMode, CommandBool from geometry_msgs.msg import PoseStamped class DroneController: def __init__(self): self.current_state = State() self.target_pos = PoseStamped() # 订阅状态 rospy.Subscriber('/mavros/state', State, self.state_cb) # 发布位置指令 self.pos_pub = rospy.Publisher('/mavros/setpoint_position/local', PoseStamped, queue_size=10) # 服务客户端 rospy.wait_for_service('/mavros/cmd/arming') self.arming_client = rospy.ServiceProxy('/mavros/cmd/arming', CommandBool) rospy.wait_for_service('/mavros/set_mode') self.set_mode_client = rospy.ServiceProxy('/mavros/set_mode', SetMode) def state_cb(self, msg): self.current_state = msg def arm(self): return self.arming_client(True) def set_mode(self, mode): return self.set_mode_client(custom_mode=mode) def run(self): rate = rospy.Rate(20) # 必须保持20Hz以上 # 先发送一些初始指令 for i in range(100): self.pos_pub.publish(self.target_pos) rate.sleep() # 切换到OFFBOARD模式 if self.set_mode("OFFBOARD"): rospy.loginfo("OFFBOARD enabled") # 解锁电机 if self.arm(): rospy.loginfo("Vehicle armed") # 主控制循环 while not rospy.is_shutdown(): # 更新目标位置 self.target_pos.header.stamp = rospy.Time.now() self.pos_pub.publish(self.target_pos) rate.sleep() if __name__ == '__main__': rospy.init_node('offboard_control') controller = DroneController() controller.run()4. Rviz可视化调试技巧
合理配置Rviz可以极大提升开发效率：
添加显示插件：
- RobotModel：显示无人机3D模型
- TF：查看坐标系关系
- Marker：显示路径点等自定义标记
关键配置参数：
<launch> <node pkg="rviz" type="rviz" name="rviz" args="-d $(find mavros)/launch/rviz_config.rviz"/> <!-- 发布静态TF变换 --> <node pkg="tf" type="static_transform_publisher" name="map_to_local_origin" args="0 0 0 0 0 0 map local_origin 100"/> </launch>- 调试技巧：
- 使用
MarkerArray可视化规划路径 - 通过
PointCloud2显示传感器数据 - 保存RViz配置避免重复设置
- 使用
5. 进阶应用：自主路径规划
结合ROS导航栈实现真正自主飞行：
- 建图与定位：
roslaunch hector_slam_launch tutorial.launch- 全局路径规划：
from nav_msgs.msg import Path from nav_msgs.srv import GetPlan # 获取从起点到终点的路径 plan_service = rospy.ServiceProxy('/global_planner/make_plan', GetPlan) start = PoseStamped() goal = PoseStamped() # 设置起点和终点坐标... path = plan_service(start, goal, 0.1).plan- 轨迹跟踪控制：
def follow_path(self, path): for pose in path.poses: self.target_pos.pose = pose.pose self.pos_pub.publish(self.target_pos) rospy.sleep(0.1) # 控制执行频率在实际项目中，我发现路径跟踪的平滑性比精确性更重要。适当增加速度控制环节可以避免无人机的"急停急走"现象。
