logo

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 权限,用于安装系统包

安装依赖:

  1. sudo apt update
  2. sudo apt install ros-jazzy-ros-gz ros-jazzy-gz-ros2-control \
  3. ros-jazzy-ros2-control ros-jazzy-ros2-controllers \
  4. ros-jazzy-xacro ros-jazzy-robot-state-publisher ros-jazzy-tf2-ros

每打开一个新终端,都要先加载 ROS 2 环境:

  1. 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 是里程计坐标系。

四、创建功能包

  1. mkdir -p ~/sim_ws/src && cd ~/sim_ws/src
  2. ros2 pkg create --build-type ament_cmake diffbot_sim
  3. mkdir -p diffbot_sim/urdf diffbot_sim/config diffbot_sim/launch

在 diffbot_sim/CMakeLists.txt 中,于 ament_package() 之前加入安装规则:

  1. install(DIRECTORY urdf config launch DESTINATION share/${PROJECT_NAME})

在 diffbot_sim/package.xml 的 <buildtool_depend> 之后加入运行依赖:

  1. <exec_depend>ros_gz_sim</exec_depend>
  2. <exec_depend>ros_gz_bridge</exec_depend>
  3. <exec_depend>robot_state_publisher</exec_depend>
  4. <exec_depend>xacro</exec_depend>
  5. <exec_depend>controller_manager</exec_depend>
  6. <exec_depend>diff_drive_controller</exec_depend>
  7. <exec_depend>joint_state_broadcaster</exec_depend>
  8. <exec_depend>gz_ros2_control</exec_depend>
  9. <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 米。

  1. <?xml version="1.0"?>
  2. <robot name="diffbot" xmlns:xacro="http://www.ros.org/wiki/xacro">
  3. <xacro:property name="wheel_radius" value="0.05"/>
  4. <xacro:property name="wheel_width" value="0.03"/>
  5. <xacro:property name="wheel_y" value="0.15"/>
  6. <link name="base_link">
  7. <inertial>
  8. <origin xyz="0 0 0.05" rpy="0 0 0"/>
  9. <mass value="5.0"/>
  10. <inertia ixx="0.030" ixy="0" ixz="0" iyy="0.071" iyz="0" izz="0.093"/>
  11. </inertial>
  12. <visual>
  13. <origin xyz="0 0 0.05" rpy="0 0 0"/>
  14. <geometry><box size="0.40 0.25 0.10"/></geometry>
  15. </visual>
  16. <collision>
  17. <origin xyz="0 0 0.05" rpy="0 0 0"/>
  18. <geometry><box size="0.40 0.25 0.10"/></geometry>
  19. </collision>
  20. </link>
  21. <xacro:macro name="wheel" params="side y_pos">
  22. <link name="${side}_wheel_link">
  23. <inertial>
  24. <mass value="0.5"/>
  25. <inertia ixx="0.00035" ixy="0" ixz="0" iyy="0.000625" iyz="0" izz="0.00035"/>
  26. </inertial>
  27. <visual>
  28. <origin xyz="0 0 0" rpy="${pi/2} 0 0"/>
  29. <geometry><cylinder radius="${wheel_radius}" length="${wheel_width}"/></geometry>
  30. </visual>
  31. <collision>
  32. <origin xyz="0 0 0" rpy="${pi/2} 0 0"/>
  33. <geometry><cylinder radius="${wheel_radius}" length="${wheel_width}"/></geometry>
  34. </collision>
  35. </link>
  36. <joint name="${side}_wheel_joint" type="continuous">
  37. <origin xyz="0 ${y_pos} 0" rpy="0 0 0"/>
  38. <parent link="base_link"/>
  39. <child link="${side}_wheel_link"/>
  40. <axis xyz="0 1 0"/>
  41. </joint>
  42. </xacro:macro>
  43. <xacro:wheel side="left" y_pos="${wheel_y}"/>
  44. <xacro:wheel side="right" y_pos="${-wheel_y}"/>
  45. <link name="caster_link">
  46. <inertial>
  47. <mass value="0.1"/>
  48. <inertia ixx="0.000036" ixy="0" ixz="0" iyy="0.000036" iyz="0" izz="0.000036"/>
  49. </inertial>
  50. <visual>
  51. <geometry><sphere radius="0.03"/></geometry>
  52. </visual>
  53. <collision>
  54. <geometry><sphere radius="0.03"/></geometry>
  55. </collision>
  56. </link>
  57. <joint name="caster_joint" type="fixed">
  58. <origin xyz="-0.17 0 -0.02" rpy="0 0 0"/>
  59. <parent link="base_link"/>
  60. <child link="caster_link"/>
  61. </joint>
  62. <ros2_control name="GazeboSimSystem" type="system">
  63. <hardware>
  64. <plugin>gz_ros2_control/GazeboSimSystem</plugin>
  65. </hardware>
  66. <joint name="left_wheel_joint">
  67. <command_interface name="velocity"/>
  68. <state_interface name="position"/>
  69. <state_interface name="velocity"/>
  70. </joint>
  71. <joint name="right_wheel_joint">
  72. <command_interface name="velocity"/>
  73. <state_interface name="position"/>
  74. <state_interface name="velocity"/>
  75. </joint>
  76. </ros2_control>
  77. <gazebo reference="caster_link">
  78. <mu1>0.001</mu1>
  79. <mu2>0.001</mu2>
  80. </gazebo>
  81. <gazebo>
  82. <plugin filename="gz_ros2_control-system" name="gz_ros2_control::GazeboSimROS2ControlPlugin">
  83. <parameters>$(find diffbot_sim)/config/diffbot_controllers.yaml</parameters>
  84. </plugin>
  85. </gazebo>
  86. </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:

  1. controller_manager:
  2. ros__parameters:
  3. update_rate: 100
  4. use_sim_time: true
  5. diff_drive_controller:
  6. type: diff_drive_controller/DiffDriveController
  7. joint_state_broadcaster:
  8. type: joint_state_broadcaster/JointStateBroadcaster
  9. diff_drive_controller:
  10. ros__parameters:
  11. left_wheel_names: ["left_wheel_joint"]
  12. right_wheel_names: ["right_wheel_joint"]
  13. wheel_separation: 0.30
  14. wheel_radius: 0.05
  15. use_stamped_vel: true
  16. base_frame_id: base_link
  17. odom_frame_id: odom
  18. enable_odom_tf: true
  19. publish_rate: 50.0
  20. cmd_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:

  1. import os
  2. from ament_index_python.packages import get_package_share_directory
  3. from launch import LaunchDescription
  4. from launch.actions import IncludeLaunchDescription, RegisterEventHandler
  5. from launch.event_handlers import OnProcessExit
  6. from launch.launch_description_sources import PythonLaunchDescriptionSource
  7. from launch.substitutions import Command
  8. from launch_ros.actions import Node
  9. from launch_ros.parameter_descriptions import ParameterValue
  10. def generate_launch_description():
  11. pkg_share = get_package_share_directory('diffbot_sim')
  12. xacro_file = os.path.join(pkg_share, 'urdf', 'diffbot.urdf.xacro')
  13. robot_description = ParameterValue(
  14. Command(['xacro ', xacro_file]), value_type=str)
  15. gz_sim = IncludeLaunchDescription(
  16. PythonLaunchDescriptionSource(os.path.join(
  17. get_package_share_directory('ros_gz_sim'),
  18. 'launch', 'gz_sim.launch.py')),
  19. launch_arguments={'gz_args': '-r empty.sdf'}.items(),
  20. )
  21. robot_state_publisher = Node(
  22. package='robot_state_publisher',
  23. executable='robot_state_publisher',
  24. output='screen',
  25. parameters=[{'robot_description': robot_description,
  26. 'use_sim_time': True}],
  27. )
  28. clock_bridge = Node(
  29. package='ros_gz_bridge',
  30. executable='parameter_bridge',
  31. arguments=['/clock@rosgraph_msgs/msg/Clock[gz.msgs.Clock'],
  32. output='screen',
  33. )
  34. spawn_robot = Node(
  35. package='ros_gz_sim',
  36. executable='create',
  37. arguments=['-topic', 'robot_description',
  38. '-name', 'diffbot', '-z', '0.1'],
  39. output='screen',
  40. )
  41. joint_state_broadcaster_spawner = Node(
  42. package='controller_manager',
  43. executable='spawner',
  44. arguments=['joint_state_broadcaster',
  45. '--controller-manager', '/controller_manager'],
  46. output='screen',
  47. )
  48. diff_drive_spawner = Node(
  49. package='controller_manager',
  50. executable='spawner',
  51. arguments=['diff_drive_controller',
  52. '--controller-manager', '/controller_manager'],
  53. output='screen',
  54. )
  55. return LaunchDescription([
  56. gz_sim,
  57. robot_state_publisher,
  58. clock_bridge,
  59. spawn_robot,
  60. RegisterEventHandler(OnProcessExit(
  61. target_action=spawn_robot,
  62. on_exit=[joint_state_broadcaster_spawner])),
  63. RegisterEventHandler(OnProcessExit(
  64. target_action=joint_state_broadcaster_spawner,
  65. on_exit=[diff_drive_spawner])),
  66. ])

启动顺序如下。先拉起 Gazebo,再发布机器人描述和 /clock,然后把小车放入仿真。小车生成后,依次加载 joint_state_broadcaster 和 diff_drive_controller。控制器必须按这个顺序加载,因为速度控制器依赖关节状态接口。

/clock 的桥接很关键。use_sim_time 为 true 的节点要从 /clock 读取时间,缺少这一步时,TF 和控制器的时间戳会停滞。

八、编译并启动

  1. cd ~/sim_ws
  2. colcon build --symlink-install
  3. source install/setup.bash
  4. ros2 launch diffbot_sim diffbot_sim.launch.py

--symlink-install 会把 URDF、YAML 和 launch 文件以链接方式安装。修改这些文件后,多数情况下重新启动 launch 即可,无需重新编译。修改 CMakeLists.txt 或 package.xml 后,需要重新执行 colcon build。

每打开一个新终端,都要先加载两层环境:

  1. source /opt/ros/jazzy/setup.bash
  2. source ~/sim_ws/install/setup.bash

Gazebo 窗口出现小车后,再打开一个新终端做下面的检查。

九、分层验证

从底层到上层逐层检查。某一层失败时,不要继续看上层。

第一层:节点和模型

  1. ros2 node list

输出中应包含 /robot_state_publisher、/controller_manager。

第二层:控制器状态

  1. ros2 control list_controllers

应看到 joint_state_broadcaster 和 diff_drive_controller 的状态均为 active。

  1. ros2 control list_hardware_interfaces

输出中应包含 left_wheel_joint/velocity 与 right_wheel_joint/velocity 两个命令接口。

第三层:话题

  1. ros2 topic list | grep -E "cmd_vel|odom|joint_states"
  2. ros2 topic info /diff_drive_controller/cmd_vel
  3. ros2 topic echo /joint_states --once

cmd_vel 的类型应显示为 geometry_msgs/msg/TwistStamped。joint_states 中应包含 left_wheel_joint 和 right_wheel_joint。

第四层:坐标变换

  1. ros2 run tf2_ros tf2_echo odom base_link

命令应持续输出平移和旋转。小车静止时,数值基本不变。

第五层:运动测试

在一个终端中以 10 赫兹持续发布速度指令:

  1. ros2 topic pub --rate 10 /diff_drive_controller/cmd_vel \
  2. geometry_msgs/msg/TwistStamped "{twist: {linear: {x: 0.2}}}"

在另一个终端查看里程计位置:

  1. 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:

  1. ros2 topic pub --rate 10 /diff_drive_controller/cmd_vel \
  2. 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 或其他定位信息。这部分内容不在本文范围内。
  • 检查车辆的重心、轮胎与地面的摩擦、电池供电等实车因素。仿真中的惯量和摩擦参数只是估计值,

发表评论

活动