ROS 2与Gazebo搭建差速小车仿真闭环
作者:快去debug2026.11.16 11:39浏览量:0简介:基于ROS 2 Jazzy与Gazebo Harmonic,从环境安装、URDF模型、控制器YAML到launch启动,搭出一台差速仿真小车。文中给出分层验证命令、排错表和迁移到实车前的检查清单,读完可独立跑通速度指令到里程计与TF的闭环。
一、读完本文你能做什么
读完本文,你会在 Gazebo 中看到一台两轮差速小车。你可以向它发送速度指令,并在 ROS 2 中读取关节状态、里程计和坐标变换。本文只涉及仿真,不涉及真实硬件,也不讨论控制算法的调参。
阅读本文需要会使用 Linux 终端,并了解 ROS 2 节点和话题的基本概念。
文中每一步都附有检查命令。某一步没有通过时,先排查这一步,再继续后面的内容。
二、准备环境
运行环境如下。
- 操作系统:Ubuntu 24.04
- ROS 2 发行版:Jazzy Jalisco
- 仿真器:Gazebo Harmonic,通过
ros_gz与 ROS 2 对接 - 需要
sudo权限,用于安装系统包
安装依赖:
sudo apt updatesudo apt install ros-jazzy-ros-gz ros-jazzy-gz-ros2-control \ros-jazzy-ros2-control ros-jazzy-ros2-controllers \ros-jazzy-xacro ros-jazzy-robot-state-publisher ros-jazzy-tf2-ros
每打开一个新终端,都要先加载 ROS 2 环境:
source /opt/ros/jazzy/setup.bash
三、约定接口
下面的代码和命令都以这组接口为准。
- 速度指令话题:
/diff_drive_controller/cmd_vel,消息类型为geometry_msgs/msg/TwistStamped。本文在控制器 YAML 中设置use_stamped_vel: true,所以类型必须是 TwistStamped。若把该参数改为false,话题类型要改为geometry_msgs/msg/Twist,发布命令也要随之修改。 - 里程计话题:
/diff_drive_controller/odom,消息类型为nav_msgs/msg/Odometry。控制器发布的话题位于控制器名称下,因此带有diff_drive_controller前缀。 - 关节状态话题:
/joint_states,消息类型为sensor_msgs/msg/JointState,由joint_state_broadcaster发布。 - 单位:线速度为米每秒,角速度为弧度每秒。
- 坐标系:
base_link的 x 轴指向车头,z 轴竖直向上。odom是里程计坐标系。
四、创建功能包
mkdir -p ~/sim_ws/src && cd ~/sim_ws/srcros2 pkg create --build-type ament_cmake diffbot_simmkdir -p diffbot_sim/urdf diffbot_sim/config diffbot_sim/launch
在 diffbot_sim/CMakeLists.txt 中,于 ament_package() 之前加入安装规则:
install(DIRECTORY urdf config launch DESTINATION share/${PROJECT_NAME})
在 diffbot_sim/package.xml 的 <buildtool_depend> 之后加入运行依赖:
<exec_depend>ros_gz_sim</exec_depend><exec_depend>ros_gz_bridge</exec_depend><exec_depend>robot_state_publisher</exec_depend><exec_depend>xacro</exec_depend><exec_depend>controller_manager</exec_depend><exec_depend>diff_drive_controller</exec_depend><exec_depend>joint_state_broadcaster</exec_depend><exec_depend>gz_ros2_control</exec_depend><exec_depend>launch_ros</exec_depend>
五、编写 URDF/xacro 模型
新建 diffbot_sim/urdf/diffbot.urdf.xacro,内容如下。base_link 位于车轮轴线高度。车轮半径为 0.05 米,两轮中心间距为 0.30 米,车身尺寸为 0.40 × 0.25 × 0.10 米,底部球形脚轮的半径为 0.03 米。
<?xml version="1.0"?><robot name="diffbot" xmlns:xacro="http://www.ros.org/wiki/xacro"><xacro:property name="wheel_radius" value="0.05"/><xacro:property name="wheel_width" value="0.03"/><xacro:property name="wheel_y" value="0.15"/><link name="base_link"><inertial><origin xyz="0 0 0.05" rpy="0 0 0"/><mass value="5.0"/><inertia ixx="0.030" ixy="0" ixz="0" iyy="0.071" iyz="0" izz="0.093"/></inertial><visual><origin xyz="0 0 0.05" rpy="0 0 0"/><geometry><box size="0.40 0.25 0.10"/></geometry></visual><collision><origin xyz="0 0 0.05" rpy="0 0 0"/><geometry><box size="0.40 0.25 0.10"/></geometry></collision></link><xacro:macro name="wheel" params="side y_pos"><link name="${side}_wheel_link"><inertial><mass value="0.5"/><inertia ixx="0.00035" ixy="0" ixz="0" iyy="0.000625" iyz="0" izz="0.00035"/></inertial><visual><origin xyz="0 0 0" rpy="${pi/2} 0 0"/><geometry><cylinder radius="${wheel_radius}" length="${wheel_width}"/></geometry></visual><collision><origin xyz="0 0 0" rpy="${pi/2} 0 0"/><geometry><cylinder radius="${wheel_radius}" length="${wheel_width}"/></geometry></collision></link><joint name="${side}_wheel_joint" type="continuous"><origin xyz="0 ${y_pos} 0" rpy="0 0 0"/><parent link="base_link"/><child link="${side}_wheel_link"/><axis xyz="0 1 0"/></joint></xacro:macro><xacro:wheel side="left" y_pos="${wheel_y}"/><xacro:wheel side="right" y_pos="${-wheel_y}"/><link name="caster_link"><inertial><mass value="0.1"/><inertia ixx="0.000036" ixy="0" ixz="0" iyy="0.000036" iyz="0" izz="0.000036"/></inertial><visual><geometry><sphere radius="0.03"/></geometry></visual><collision><geometry><sphere radius="0.03"/></geometry></collision></link><joint name="caster_joint" type="fixed"><origin xyz="-0.17 0 -0.02" rpy="0 0 0"/><parent link="base_link"/><child link="caster_link"/></joint><ros2_control name="GazeboSimSystem" type="system"><hardware><plugin>gz_ros2_control/GazeboSimSystem</plugin></hardware><joint name="left_wheel_joint"><command_interface name="velocity"/><state_interface name="position"/><state_interface name="velocity"/></joint><joint name="right_wheel_joint"><command_interface name="velocity"/><state_interface name="position"/><state_interface name="velocity"/></joint></ros2_control><gazebo reference="caster_link"><mu1>0.001</mu1><mu2>0.001</mu2></gazebo><gazebo><plugin filename="gz_ros2_control-system" name="gz_ros2_control::GazeboSimROS2ControlPlugin"><parameters>$(find diffbot_sim)/config/diffbot_controllers.yaml</parameters></plugin></gazebo></robot>
这里有几点需要注意。
- 关节名
left_wheel_joint和right_wheel_joint必须与控制器 YAML 中的名称完全一致,包括大小写。 <ros2_control>块中列出的关节,必须是 URDF 中存在的continuous关节。- 车轮旋转轴为
0 1 0。在这个约定下,关节角速度为正时,车轮顶部向车头方向运动,小车前进。 - 脚轮是固定关节的球体,在 Gazebo 中会产生较大摩擦,导致车身转向时拖滑。这里把它的摩擦系数设为很小的值,减轻这一影响。若 Gazebo 报告
mu1或mu2无法识别,请检查gz_ros2_control与 Gazebo Harmonic 的版本是否匹配。
六、配置控制器 YAML
新建 diffbot_sim/config/diffbot_controllers.yaml:
controller_manager:ros__parameters:update_rate: 100use_sim_time: truediff_drive_controller:type: diff_drive_controller/DiffDriveControllerjoint_state_broadcaster:type: joint_state_broadcaster/JointStateBroadcasterdiff_drive_controller:ros__parameters:left_wheel_names: ["left_wheel_joint"]right_wheel_names: ["right_wheel_joint"]wheel_separation: 0.30wheel_radius: 0.05use_stamped_vel: truebase_frame_id: base_linkodom_frame_id: odomenable_odom_tf: truepublish_rate: 50.0cmd_vel_timeout: 0.5
各参数的含义如下。
update_rate:控制器管理器的更新频率,单位为赫兹。left_wheel_names、right_wheel_names:左右轮关节名,必须与 URDF 一致。wheel_separation:两轮中心间距,必须与 URDF 中的 0.30 米一致。两者不一致时,里程计会有系统性偏差。wheel_radius:车轮半径,必须与 URDF 中的 0.05 米一致。use_stamped_vel:为true时,速度指令为 TwistStamped。enable_odom_tf:为true时,控制器发布odom到base_link的坐标变换。cmd_vel_timeout:超过这个时间没有收到速度指令,控制器会把车速置零。
七、编写 launch 文件
新建 diffbot_sim/launch/diffbot_sim.launch.py:
import osfrom ament_index_python.packages import get_package_share_directoryfrom launch import LaunchDescriptionfrom launch.actions import IncludeLaunchDescription, RegisterEventHandlerfrom launch.event_handlers import OnProcessExitfrom launch.launch_description_sources import PythonLaunchDescriptionSourcefrom launch.substitutions import Commandfrom launch_ros.actions import Nodefrom launch_ros.parameter_descriptions import ParameterValuedef generate_launch_description():pkg_share = get_package_share_directory('diffbot_sim')xacro_file = os.path.join(pkg_share, 'urdf', 'diffbot.urdf.xacro')robot_description = ParameterValue(Command(['xacro ', xacro_file]), value_type=str)gz_sim = IncludeLaunchDescription(PythonLaunchDescriptionSource(os.path.join(get_package_share_directory('ros_gz_sim'),'launch', 'gz_sim.launch.py')),launch_arguments={'gz_args': '-r empty.sdf'}.items(),)robot_state_publisher = Node(package='robot_state_publisher',executable='robot_state_publisher',output='screen',parameters=[{'robot_description': robot_description,'use_sim_time': True}],)clock_bridge = Node(package='ros_gz_bridge',executable='parameter_bridge',arguments=['/clock@rosgraph_msgs/msg/Clock[gz.msgs.Clock'],output='screen',)spawn_robot = Node(package='ros_gz_sim',executable='create',arguments=['-topic', 'robot_description','-name', 'diffbot', '-z', '0.1'],output='screen',)joint_state_broadcaster_spawner = Node(package='controller_manager',executable='spawner',arguments=['joint_state_broadcaster','--controller-manager', '/controller_manager'],output='screen',)diff_drive_spawner = Node(package='controller_manager',executable='spawner',arguments=['diff_drive_controller','--controller-manager', '/controller_manager'],output='screen',)return LaunchDescription([gz_sim,robot_state_publisher,clock_bridge,spawn_robot,RegisterEventHandler(OnProcessExit(target_action=spawn_robot,on_exit=[joint_state_broadcaster_spawner])),RegisterEventHandler(OnProcessExit(target_action=joint_state_broadcaster_spawner,on_exit=[diff_drive_spawner])),])
启动顺序如下。先拉起 Gazebo,再发布机器人描述和 /clock,然后把小车放入仿真。小车生成后,依次加载 joint_state_broadcaster 和 diff_drive_controller。控制器必须按这个顺序加载,因为速度控制器依赖关节状态接口。
/clock 的桥接很关键。use_sim_time 为 true 的节点要从 /clock 读取时间,缺少这一步时,TF 和控制器的时间戳会停滞。
八、编译并启动
cd ~/sim_wscolcon build --symlink-installsource install/setup.bashros2 launch diffbot_sim diffbot_sim.launch.py
--symlink-install 会把 URDF、YAML 和 launch 文件以链接方式安装。修改这些文件后,多数情况下重新启动 launch 即可,无需重新编译。修改 CMakeLists.txt 或 package.xml 后,需要重新执行 colcon build。
每打开一个新终端,都要先加载两层环境:
source /opt/ros/jazzy/setup.bashsource ~/sim_ws/install/setup.bash
Gazebo 窗口出现小车后,再打开一个新终端做下面的检查。
九、分层验证
从底层到上层逐层检查。某一层失败时,不要继续看上层。
第一层:节点和模型
ros2 node list
输出中应包含 /robot_state_publisher、/controller_manager。
第二层:控制器状态
ros2 control list_controllers
应看到 joint_state_broadcaster 和 diff_drive_controller 的状态均为 active。
ros2 control list_hardware_interfaces
输出中应包含 left_wheel_joint/velocity 与 right_wheel_joint/velocity 两个命令接口。
第三层:话题
ros2 topic list | grep -E "cmd_vel|odom|joint_states"ros2 topic info /diff_drive_controller/cmd_velros2 topic echo /joint_states --once
cmd_vel 的类型应显示为 geometry_msgs/msg/TwistStamped。joint_states 中应包含 left_wheel_joint 和 right_wheel_joint。
第四层:坐标变换
ros2 run tf2_ros tf2_echo odom base_link
命令应持续输出平移和旋转。小车静止时,数值基本不变。
第五层:运动测试
在一个终端中以 10 赫兹持续发布速度指令:
ros2 topic pub --rate 10 /diff_drive_controller/cmd_vel \geometry_msgs/msg/TwistStamped "{twist: {linear: {x: 0.2}}}"
在另一个终端查看里程计位置:
ros2 topic echo /diff_drive_controller/odom --field pose.pose.position
线速度为 0.2 米每秒时,两轮角速度均为 0.2 ÷ 0.05 = 4 弧度每秒。x 坐标应随时间增大,增长速率接近 0.2 米每秒。按 Ctrl+C 停止发布后,小车会在 cmd_vel_timeout 之后停下。
再测试转向。把 linear.x 改为 0,angular.z 设为 0.5:
ros2 topic pub --rate 10 /diff_drive_controller/cmd_vel \geometry_msgs/msg/TwistStamped "{twist: {angular: {z: 0.5}}}"
小车应原地逆时针转动。左轮反转,右轮正转,速度均为 1.5 弧度每秒。
十、排错表
| 现象 | 可能原因 | 处理方法 |
|---|---|---|
| Gazebo 中没有小车 | URDF 语法错误或 robot_description 未发布 |
运行 xacro ~/sim_ws/src/diffbot_sim/urdf/diffbot.urdf.xacro,检查是否报错;再用 ros2 topic echo /robot_description --once 确认话题有内容 |
spawner 报 Could not contact service |
gz_ros2_control 插件未加载 |
查看 Gazebo 终端日志,确认 ros-jazzy-gz-ros2-control 已安装,且 parameters 中的 YAML 路径正确 |
| 控制器加载失败,提示关节不存在 | YAML 中的关节名与 URDF 不一致 | 核对 left_wheel_names、right_wheel_names 与 URDF 中关节名的大小写 |
| 控制器为 active,但小车不动 | 速度指令类型与 use_stamped_vel 不匹配 |
运行 ros2 topic info /diff_drive_controller/cmd_vel,确认类型与 YAML 一致 |
| 小车动一下就停 | 只发布了一次指令,超过 cmd_vel_timeout 后速度归零 |
使用 --rate 10 持续发布 |
| 小车前进时向后走 | 左右轮名称对调,或车轮旋转轴方向与约定相反 | 核对 left_wheel_names 与 right_wheel_names,并确认 axis xyz="0 1 0" |
| 车身在原地抖动或拖滑 | 脚轮摩擦过大,或车身生成高度过低导致穿透 | 确认 caster_link 的摩擦系数已设置,并保持 -z 0.1 的生成高度 |
| odom 与实际位移偏差大 | wheel_separation 或 wheel_radius 与 URDF 不一致 |
对照 URDF 中的 0.30 米轮距和 0.05 米半径修改 YAML |
tf2_echo odom base_link 没有输出 |
enable_odom_tf 为 false,或坐标系名称不一致 |
运行 ros2 param get /diff_drive_controller enable_odom_tf,并核对 odom_frame_id 与 base_frame_id |
| 时间不前进,TF 停滞 | /clock 未桥接,而节点设置了 use_sim_time |
运行 ros2 topic echo /clock --once,确认 clock_bridge 节点正常运行 |
十一、迁移到实车前的检查清单
仿真通过不代表实车可以直接运行。迁移前逐项确认下面的内容。
- 实测车轮半径与轮距,替换 YAML 中的
wheel_radius和wheel_separation。用卷尺测量小车直线行驶 1 米的里程计误差,并据此修正参数。 - 把
gz_ros2_control替换为真实电机驱动对应的hardware_interface插件。确认编码器输出的位置和速度单位为弧度与弧度每秒,并与 URDF 中的接口定义一致。 - 为速度设置上限。控制器的线速度和角速度限幅参数以所装版本的官方文档为准,避免指令过大导致电机过载。
- 保留
cmd_vel_timeout,并在上位机或硬件侧增加急停逻辑。通信中断时,车辆必须停止。 - 关闭
use_sim_time,改用系统时钟,并检查各传感器与控制器的时间戳是否对齐。 - 轮式里程计会随地面打滑而累积误差。若需要长距离定位,应融合 IMU 或其他定位信息。这部分内容不在本文范围内。
- 检查车辆的重心、轮胎与地面的摩擦、电池供电等实车因素。仿真中的惯量和摩擦参数只是估计值,

登录后可评论,请前往 登录 或 注册