ROS2 Jazzy/Rollin连接PX4仿真与实机切换指南：一个Launch文件搞定两种模式

ROS2 Jazzy/Rollin连接PX4仿真与实机切换指南：一个Launch文件搞定两种模式

当你在ROS2环境中开发无人机算法时，最头疼的莫过于在仿真测试和实机验证之间来回切换。每次都要修改配置文件、重新编译、检查连接状态...这种重复劳动不仅浪费时间，还容易出错。今天我要分享的这套方法，可以让你用一个launch文件无缝切换PX4仿真和实机模式，把宝贵的时间留给真正的算法开发。

1. 环境准备与基础配置

在开始之前，确保你已经完成以下基础环境搭建：

• ROS2 Jazzy/Rollin：推荐使用Ubuntu 22.04或24.04 LTS系统
• PX4固件：v1.14或更新版本
• MAVROS2：从源码编译安装最新版本

安装必要的依赖包：

sudo apt install python3-vcstool python3-rosinstall-generator python3-osrf-pycommon

创建工作空间并获取MAVROS2源码：

mkdir -p ~/ros2_ws/src cd ~/ros2_ws rosinstall_generator --format repos mavlink mavros | tee /tmp/mav.repos vcs import src < /tmp/mav.repos rosdep install --from-paths src --ignore-src -y

提示：如果遇到网络问题，可以尝试更换国内镜像源或使用代理工具加速下载

2. 通信机制深度解析

理解PX4与ROS2之间的通信机制是配置切换的关键。两种连接方式在底层实现上有本质区别：

仿真模式使用UDP协议，PX4 SITL默认监听14557端口，而QGC通常使用14540端口。这种模式下，MAVROS2通过udp://:14540@127.0.0.1:14557这样的URL连接到PX4。

实机模式则需要通过物理串口连接，典型的配置如/dev/ttyACM0:2000000，其中2000000是推荐的波特率设置。

3. Launch文件智能配置

核心解决方案在于创建一个智能化的launch文件，能够根据环境自动切换连接方式。以下是完整的px4.launch.py实现：

from launch import LaunchDescription from launch.substitutions import EnvironmentVariable from launch.actions import DeclareLaunchArgument from launch_ros.actions import Node def generate_launch_description(): # 通过环境变量决定连接模式 fcu_url = EnvironmentVariable('PX4_CONNECTION_MODE', default_value='udp://:14540@127.0.0.1:14557') return LaunchDescription([ DeclareLaunchArgument( 'fcu_url', default_value=fcu_url, description='PX4连接URL (udp://或串口设备)' ), Node( package='mavros', executable='mavros_node', name='mavros', output='screen', parameters=[{ 'fcu_url': LaunchConfiguration('fcu_url'), 'system_id': 1, 'component_id': 191, 'target_system_id': 1, 'target_component_id': 1, }] ) ])

这个launch文件的关键特点：

1. 环境变量控制：通过PX4_CONNECTION_MODE环境变量决定连接方式
2. 默认仿真模式：未指定时自动使用UDP连接PX4 SITL
3. 参数完整配置：包含了MAVROS2推荐的基础参数设置

4. 实战切换技巧

4.1 基础切换方法

切换到仿真模式：

export PX4_CONNECTION_MODE="udp://:14540@127.0.0.1:14557" ros2 launch mavros px4.launch.py

切换到实机模式：

export PX4_CONNECTION_MODE="/dev/ttyACM0:2000000" ros2 launch mavros px4.launch.py

4.2 高级自动化技巧

对于需要频繁切换的场景，可以创建两个简单的shell函数添加到你的.bashrc中：

px4_sim() { export PX4_CONNECTION_MODE="udp://:14540@127.0.0.1:14557" ros2 launch mavros px4.launch.py } px4_real() { export PX4_CONNECTION_MODE="/dev/ttyACM0:2000000" sudo chmod 666 /dev/ttyACM0 ros2 launch mavros px4.launch.py }

这样只需要在终端输入px4_sim或px4_real就能快速切换模式。

4.3 参数配置对比

无论哪种模式，PX4端都需要正确配置MAVLink参数：

注意：切换到实机模式后，建议检查/dev/ttyACM*的权限，必要时使用sudo chmod 666 /dev/ttyACM0

5. 常见问题排查

在实际使用中可能会遇到以下问题：

1. 连接超时：

   • 仿真模式：检查PX4 SITL是否正常运行，pxh> commander arm查看状态
   • 实机模式：确认飞控LED状态，检查USB连接是否松动

2. MAVROS2无法启动：

   # 检查MAVROS2安装 ros2 pkg list | grep mavros # 重新编译工作空间 colcon build --packages-select mavros

3. 参数同步失败：

   • 确保PX4和MAVROS2使用兼容的MAVLink版本
   • 检查~/.ros/mavros/px4_pluginlists.yaml配置

4. 性能问题：

   • 实机模式下如果出现数据丢失，尝试降低波特率到921600
   • 仿真模式下可以调整UDP缓冲区大小：

     parameters=[{ 'fcu_url': LaunchConfiguration('fcu_url'), 'uart_rcv_buf_size': 1024*1024, # ... }]

6. 扩展应用场景

这套切换机制可以进一步集成到更复杂的开发流程中：

CI/CD自动化测试：

# .gitlab-ci.yml 示例 test_simulation: script: - export PX4_CONNECTION_MODE="udp://:14540@127.0.0.1:14557" - ros2 launch mavros px4.launch.py & - ros2 test your_test_package test_hardware: script: - export PX4_CONNECTION_MODE="/dev/ttyACM0:2000000" - ros2 launch mavros px4.launch.py & - ros2 test your_hw_test_package

多机协同开发：

# 多机launch文件示例 def generate_launch_description(): drones = [ {'id': 1, 'port': 14560}, {'id': 2, 'port': 14561} ] nodes = [] for drone in drones: nodes.append(Node( package='mavros', executable='mavros_node', name=f'mavros_{drone["id"]}', parameters=[{ 'fcu_url': f'udp://:14540@127.0.0.1:{drone["port"]}', 'system_id': drone['id'], # ... }] )) return LaunchDescription(nodes)

在实际项目中，我发现最实用的技巧是在launch文件中添加模式检测逻辑，自动识别当前是仿真还是实机环境。这可以通过检查/dev/ttyACM*设备是否存在来实现，让切换过程完全自动化。