保姆级教程：用MAVROS和ROS Noetic控制PX4无人机（从话题订阅到飞控指令）

从零开始用MAVROS与ROS Noetic操控PX4无人机的完整实践指南当你第一次拿到一台搭载PX4飞控的无人机和安装了ROS的机载电脑时最迫切的需求可能就是让它动起来。MAVROS作为ROS与PX4之间的桥梁是实现这一目标的关键工具。本文将带你从最基本的MAVROS安装配置开始逐步深入到关键话题的订阅与发布最终实现通过Python脚本控制无人机移动的全过程。1. 环境准备与MAVROS安装在开始之前确保你的系统已经安装了ROS Noetic。如果你使用的是Ubuntu 20.04可以通过以下命令安装ROS Noetic完整版sudo apt install ros-noetic-desktop-full接下来安装MAVROS及相关依赖包sudo apt install ros-noetic-mavros ros-noetic-mavros-extras wget https://raw.githubusercontent.com/mavlink/mavros/master/mavros/scripts/install_geographiclib_datasets.sh chmod x install_geographiclib_datasets.sh sudo ./install_geographiclib_datasets.sh安装完成后建议创建一个专门的工作空间来管理你的无人机项目mkdir -p ~/px4_ws/src cd ~/px4_ws/src catkin_init_workspace cd .. catkin_make source devel/setup.bash常见问题排查如果遇到地理数据库安装失败可以尝试手动下载并解压到/usr/share/GeographicLib目录确保你的用户有权限访问串口设备通常需要将用户加入dialout组sudo usermod -a -G dialout $USER2. MAVROS与PX4的连接配置连接PX4飞控与机载电脑有多种方式最常用的是通过USB或数传电台。无论哪种方式都需要正确配置MAVROS的启动文件。创建一个新的launch文件px4.launchlaunch arg namefcu_url default/dev/ttyACM0:57600 / arg namegcs_url default / arg nametgt_system default1 / arg nametgt_component default1 / include file$(find mavros)/launch/px4.launch arg namefcu_url value$(arg fcu_url) / arg namegcs_url value$(arg gcs_url) / arg nametgt_system value$(arg tgt_system) / arg nametgt_component value$(arg tgt_component) / /include /launch启动MAVROS节点roslaunch mavros px4.launch成功连接后你应该能看到终端输出类似以下信息[ INFO] [1620000000.000000000]: MAVROS started. MY ID 1.240, TARGET ID 1.1关键诊断命令检查MAVROS与飞控的连接状态rostopic echo /mavros/state确保connected字段为True查看所有可用话题rostopic list3. 关键话题解析与数据订阅MAVROS提供了大量话题来与PX4飞控交互。理解这些话题的作用是控制无人机的基础。3.1 状态监控话题话题名称数据类型描述/mavros/statemavros_msgs/State飞控连接状态/mavros/batterysensor_msgs/BatteryState电池状态/mavros/imu/datasensor_msgs/ImuIMU数据/mavros/global_position/globalsensor_msgs/NavSatFix全球位置(GPS)/mavros/local_position/posegeometry_msgs/PoseStamped本地位置估计创建一个Python脚本订阅这些关键话题#!/usr/bin/env python import rospy from mavros_msgs.msg import State from sensor_msgs.msg import BatteryState, Imu, NavSatFix from geometry_msgs.msg import PoseStamped def state_cb(msg): print(fConnected: {msg.connected}, Armed: {msg.armed}, Mode: {msg.mode}) def battery_cb(msg): print(fVoltage: {msg.voltage:.2f}V, Remaining: {msg.percentage*100:.1f}%) def imu_cb(msg): print(fOrientation: {msg.orientation}) def gps_cb(msg): print(fGPS: Lat {msg.latitude:.6f}, Lon {msg.longitude:.6f}, Alt {msg.altitude:.2f}) def pose_cb(msg): print(fLocal Position: X {msg.pose.position.x:.2f}, Y {msg.pose.position.y:.2f}, Z {msg.pose.position.z:.2f}) rospy.init_node(drone_monitor) state_sub rospy.Subscriber(/mavros/state, State, state_cb) battery_sub rospy.Subscriber(/mavros/battery, BatteryState, battery_cb) imu_sub rospy.Subscriber(/mavros/imu/data, Imu, imu_cb) gps_sub rospy.Subscriber(/mavros/global_position/global, NavSatFix, gps_cb) pose_sub rospy.Subscriber(/mavros/local_position/pose, PoseStamped, pose_cb) rospy.spin()3.2 控制模式设置在发送任何控制指令前必须确保无人机处于正确的飞行模式。常用的模式包括POSCTL位置控制模式OFFBOARDOffboard控制模式用于外部控制AUTO.MISSION任务模式MANUAL手动模式设置飞行模式的示例代码from mavros_msgs.srv import SetMode def set_mode(mode): rospy.wait_for_service(/mavros/set_mode) try: set_mode_srv rospy.ServiceProxy(/mavros/set_mode, SetMode) response set_mode_srv(custom_modemode) return response.mode_sent except rospy.ServiceException as e: print(fService call failed: {e}) return False4. 无人机控制指令发布4.1 解锁与上锁在发送位置或速度指令前需要先解锁无人机电机from mavros_msgs.srv import CommandBool def arm(arm): rospy.wait_for_service(/mavros/cmd/arming) try: arm_srv rospy.ServiceProxy(/mavros/cmd/arming, CommandBool) response arm_srv(valuearm) return response.success except rospy.ServiceException as e: print(fService call failed: {e}) return False4.2 位置控制位置控制是最常用的控制方式之一。以下是一个完整的位置控制示例#!/usr/bin/env python import rospy from geometry_msgs.msg import PoseStamped from mavros_msgs.srv import SetMode, CommandBool from mavros_msgs.msg import State current_state State() def state_cb(msg): global current_state current_state msg rospy.init_node(position_control) state_sub rospy.Subscriber(/mavros/state, State, state_cb) local_pos_pub rospy.Publisher(/mavros/setpoint_position/local, PoseStamped, queue_size10) rate rospy.Rate(20) # 必须保持20Hz以上 # 等待MAVROS连接 while not current_state.connected: rate.sleep() # 发送一些初始设定点 for i in range(100): pose PoseStamped() pose.pose.position.x 0 pose.pose.position.y 0 pose.pose.position.z 2 local_pos_pub.publish(pose) rate.sleep() # 设置Offboard模式 if set_mode(OFFBOARD): print(Offboard enabled) else: print(Failed to set Offboard) # 解锁无人机 if arm(True): print(Armed) else: print(Arming failed) # 主控制循环 for i in range(200): pose PoseStamped() pose.pose.position.x 2 * (i / 200.0) pose.pose.position.y 0 pose.pose.position.z 2 local_pos_pub.publish(pose) rate.sleep() # 降落 for i in range(100): pose PoseStamped() pose.pose.position.x 2 pose.pose.position.y 0 pose.pose.position.z 2 - (i / 50.0) local_pos_pub.publish(pose) rate.sleep() # 上锁 arm(False)4.3 速度控制速度控制提供了更灵活的运动方式from geometry_msgs.msg import TwistStamped vel_pub rospy.Publisher(/mavros/setpoint_velocity/cmd_vel, TwistStamped, queue_size10) def send_velocity(vx, vy, vz, yaw_rate0): twist TwistStamped() twist.twist.linear.x vx twist.twist.linear.y vy twist.twist.linear.z vz twist.twist.angular.z yaw_rate vel_pub.publish(twist)5. 高级功能与调试技巧5.1 参数配置PX4飞控有大量可配置参数可以通过MAVROS访问from mavros_msgs.srv import ParamGet, ParamSet def get_param(param_id): rospy.wait_for_service(/mavros/param/get) try: param_get rospy.ServiceProxy(/mavros/param/get, ParamGet) response param_get(param_idparam_id) return response.value except rospy.ServiceException as e: print(fService call failed: {e}) return None def set_param(param_id, value): rospy.wait_for_service(/mavros/param/set) try: param_set rospy.ServiceProxy(/mavros/param/set, ParamSet) response param_set(param_idparam_id, valuevalue) return response.success except rospy.ServiceException as e: print(fService call failed: {e}) return False5.2 常见问题解决问题1MAVROS无法连接飞控检查物理连接是否正常确认串口设备路径是否正确如/dev/ttyACM0检查波特率设置是否匹配通常PX4使用57600确保用户有串口访问权限问题2Offboard模式无法启用确保在切换至Offboard模式前持续发送设定点至少20Hz检查COM_RCL_EXCEPT参数是否允许Offboard模式确认遥控器开关设置正确问题3无人机对指令无响应检查当前飞行模式是否正确确认无人机已解锁查看/mavros/setpoint_position/local话题是否有数据发布检查飞控状态灯是否显示正常5.3 性能优化建议使用rosrun topic hz监控关键话题的发布频率对于实时性要求高的应用考虑使用roscpp替代rospy合理设置ROS参数服务器的参数如/mavros/conn/heartbeat_rate在资源受限的设备上可以禁用不必要的MAVROS插件6. 实战项目自主飞行任务结合前面学到的知识我们可以实现一个简单的自主飞行任务#!/usr/bin/env python import rospy import math from geometry_msgs.msg import PoseStamped from mavros_msgs.srv import SetMode, CommandBool from mavros_msgs.msg import State class DroneController: def __init__(self): rospy.init_node(mission_control) self.current_state State() self.state_sub rospy.Subscriber(/mavros/state, State, self.state_cb) self.local_pos_pub rospy.Publisher(/mavros/setpoint_position/local, PoseStamped, queue_size10) self.rate rospy.Rate(20) def state_cb(self, msg): self.current_state msg def set_mode(self, mode): rospy.wait_for_service(/mavros/set_mode) try: set_mode_srv rospy.ServiceProxy(/mavros/set_mode, SetMode) response set_mode_srv(custom_modemode) return response.mode_sent except rospy.ServiceException as e: print(fService call failed: {e}) return False def arm(self, arm): rospy.wait_for_service(/mavros/cmd/arming) try: arm_srv rospy.ServiceProxy(/mavros/cmd/arming, CommandBool) response arm_srv(valuearm) return response.success except rospy.ServiceException as e: print(fService call failed: {e}) return False def fly_square(self, size2, height2): # 等待连接 while not self.current_state.connected: self.rate.sleep() # 发送初始设定点 for i in range(100): pose PoseStamped() pose.pose.position.z height self.local_pos_pub.publish(pose) self.rate.sleep() # 设置Offboard模式 if not self.set_mode(OFFBOARD): print(Failed to set Offboard) return # 解锁 if not self.arm(True): print(Failed to arm) return # 方形轨迹 waypoints [ (size, 0, height), (size, size, height), (0, size, height), (0, 0, height) ] for wp in waypoints: for i in range(100): # 每个点停留5秒 pose PoseStamped() pose.pose.position.x wp[0] pose.pose.position.y wp[1] pose.pose.position.z wp[2] self.local_pos_pub.publish(pose) self.rate.sleep() # 降落 for i in range(100): pose PoseStamped() pose.pose.position.z height - (i / 50.0) self.local_pos_pub.publish(pose) self.rate.sleep() # 上锁 self.arm(False) if __name__ __main__: controller DroneController() controller.fly_square()这个项目展示了如何通过MAVROS实现一个完整的无人机控制流程从基础连接到高级任务执行。在实际应用中你可能需要根据具体需求调整控制算法、添加安全检查和故障处理机制。