ROS2系列教程：机器人模型导入仿真实战

发布时间：2026-09-08 18:06:24

🕒 阅读时间：20 分钟📝 字数：2924👀 阅读量：Loading...

本文是 ROS2 系列教程的第 20 篇

本文是 ROS2 系列教程的第 20 篇：机器人模型导入仿真实战。前四篇我们分别学会了 URDF 建模、Xacro 参数化、Gazebo 世界搭建、传感器插件配置，但都是“点状”知识。本篇把它们串成一条完整生产线：从零构建一个规范的仿真工程（description + bringup 双包结构），把 Xacro 小车 + 激光雷达 + IMU + 差速插件整合，一键 launch 进 Gazebo，并用 RViz 做全链路验收。这是建模仿真阶段的收官之战，做完你将拥有一个“开箱即用”的仿真小车，直接喂给第 21 篇的 SLAM 建图。

一、仿真工程的规范结构

1.1 为什么拆两个包

大型 ROS2 工程通常拆成两个功能包：

包	职责	内容
`xxx_description`	描述机器人	URDF/Xacro、网格、launch（显示用）
`xxx_bringup`	启动系统	world 文件、launch（仿真/导航/完整系统）

分工原则：description 只管“机器人长什么样”，bringup 管“系统怎么跑”。导航、SLAM 等后续阶段都在 bringup 里加 launch，description 不变。

1.2 目录结构

1
my_robot_ws/src/
2
├── my_robot_description/
3
│   ├── CMakeLists.txt
4
│   ├── package.xml
5
│   ├── urdf/
6
│   │   └── demo_car.xacro
7
│   ├── meshes/                # 自定义网格（可选）
8
│   └── launch/
9
│       └── display.launch.py  # RViz 显示
10
└── my_robot_bringup/
11
    ├── CMakeLists.txt
12
    ├── package.xml
13
    ├── worlds/
14
    │   └── my_world.world
15
    └── launch/
16
        └── gazebo.launch.py   # 仿真启动
17
        └── sim.launch.py      # 仿真 + 显示

1.3 建包命令

1
cd ~/my_robot_ws/src
2
ros2 pkg create my_robot_description --build-type ament_cmake --license Apache-2.0
3
ros2 pkg create my_robot_bringup --build-type ament_cmake --license Apache-2.0
4
mkdir -p my_robot_description/urdf my_robot_description/launch
5
mkdir -p my_robot_bringup/worlds my_robot_bringup/launch

CMakeLists.txt 安装目录（关键，否则 launch/urdf 找不到）：

1
install(DIRECTORY urdf launch
2
  DESTINATION share/${PROJECT_NAME})
3

4
# bringup 包同样
5
install(DIRECTORY worlds launch
6
  DESTINATION share/${PROJECT_NAME})

二、整合版 Xacro：小车全家桶

2.1 完整 demo_car.xacro

把前几篇的组件合成一个文件（属性 + 底盘 + 轮子宏 + 激光 + IMU + 差速插件）：

1
<?xml version="1.0"?>
2
<robot name="demo_car" xmlns:xacro="http://www.ros.org/wiki/xacro">
3

4
  <!-- ===== 全局属性 ===== -->
5
  <xacro:property name="chassis_length" value="0.45"/>
6
  <xacro:property name="chassis_width"  value="0.30"/>
7
  <xacro:property name="chassis_height" value="0.12"/>
8
  <xacro:property name="wheel_radius"   value="0.08"/>
9
  <xacro:property name="wheel_width"    value="0.03"/>
10
  <xacro:property name="wheel_base"     value="0.19"/>
11
  <xacro:property name="wheel_axis_z"   value="${-chassis_height/2}"/>
12
  <xacro:property name="laser_z"        value="${chassis_height/2}"/>
13
  <xacro:property name="imu_z"          value="${chassis_height/2}"/>
14

15
  <!-- ===== 底盘 ===== -->
16
  <link name="base_link">
17
    <inertial>
18
      <mass value="3.0"/>
19
      <inertia ixx="0.02" ixy="0" ixz="0" iyy="0.03" iyz="0" izz="0.02"/>
20
    </inertial>
21
    <visual>
22
      <geometry>
23
        <box size="${chassis_length} ${chassis_width} ${chassis_height}"/>
24
      </geometry>
25
      <material name="blue"><color rgba="0.2 0.4 0.8 1"/></material>
26
    </visual>
27
    <collision>
28
      <geometry>
29
        <box size="${chassis_length} ${chassis_width} ${chassis_height}"/>
30
      </geometry>
31
    </collision>
32
  </link>
33

34
  <!-- ===== 轮子宏 ===== -->
35
  <xacro:macro name="wheel" params="side">
36
    <link name="wheel_${side}">
37
      <inertial>
38
        <mass value="0.5"/>
39
        <inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.001"/>
40
      </inertial>
41
      <visual>
42
        <geometry>
43
          <cylinder radius="${wheel_radius}" length="${wheel_width}"/>
44
        </geometry>
45
        <material name="dark"><color rgba="0.1 0.1 0.1 1"/></material>
46
      </visual>
47
      <collision>
48
        <geometry>
49
          <cylinder radius="${wheel_radius}" length="${wheel_width}"/>
50
        </geometry>
51
      </collision>
52
    </link>
53
    <joint name="base_to_wheel_${side}" type="revolute">
54
      <parent link="base_link"/>
55
      <child link="wheel_${side}"/>
56
      <origin xyz="0.15 ${side * wheel_base} ${wheel_axis_z}" rpy="0 0 0"/>
57
      <axis xyz="0 1 0"/>
58
      <limit effort="10" velocity="10" lower="-3.14" upper="3.14"/>
59
    </joint>
60
  </xacro:macro>
61

62
  <xacro:wheel side="1"/>
63
  <xacro:wheel side="-1"/>
64

65
  <!-- ===== 激光雷达 ===== -->
66
  <link name="lidar_link">
67
    <inertial>
68
      <mass value="0.2"/>
69
      <inertia ixx="0.0001" ixy="0" ixz="0" iyy="0.0001" iyz="0" izz="0.0001"/>
70
    </inertial>
71
    <visual>
72
      <geometry>
73
        <cylinder radius="0.05" length="0.06"/>
74
      </geometry>
75
      <material name="red"><color rgba="0.9 0.2 0.2 1"/></material>
76
    </visual>
77
    <collision>
78
      <geometry>
79
        <cylinder radius="0.05" length="0.06"/>
80
      </geometry>
81
    </collision>
82
  </link>
83
  <joint name="base_to_lidar" type="fixed">
84
    <parent link="base_link"/>
85
    <child link="lidar_link"/>
86
    <origin xyz="0.1 0 ${laser_z}" rpy="0 0 0"/>
87
  </joint>
88

89
  <!-- ===== IMU ===== -->
90
  <link name="imu_link">
91
    <inertial>
92
      <mass value="0.05"/>
93
      <inertia ixx="0.0001" ixy="0" ixz="0" iyy="0.0001" iyz="0" izz="0.0001"/>
94
    </inertial>
95
  </link>
96
  <joint name="base_to_imu" type="fixed">
97
    <parent link="base_link"/>
98
    <child link="imu_link"/>
99
    <origin xyz="0 0 ${imu_z}" rpy="0 0 0"/>
100
  </joint>
101

102
  <!-- ===== Gazebo 插件 ===== -->
103
  <!-- 差速驱动 -->
104
  <gazebo>
105
    <plugin name="diff_drive" filename="libgazebo_ros_diff_drive.so">
106
      <ros>
107
        <namespace>/</namespace>
108
        <remapping>cmd_vel:=cmd_vel</remapping>
109
      </ros>
110
      <update_rate>30</update_rate>
111
      <left_joint>base_to_wheel_1</left_joint>
112
      <right_joint>base_to_wheel_-1</right_joint>
113
      <wheel_separation>0.38</wheel_separation>
114
      <wheel_diameter>0.16</wheel_diameter>
115
      <max_wheel_torque>20</max_wheel_torque>
116
      <max_wheel_acceleration>1.0</max_wheel_acceleration>
117
      <command_topic>cmd_vel</command_topic>
118
      <publish_odom>true</publish_odom>
119
      <publish_odom_tf>true</publish_odom_tf>
120
      <odometry_frame>odom</odometry_frame>
121
      <robot_base_frame>base_link</robot_base_frame>
122
    </plugin>
123
  </gazebo>
124

125
  <!-- 关节状态上报 -->
126
  <gazebo>
127
    <plugin name="joint_state_pub" filename="libgazebo_ros_joint_state_publisher.so">
128
      <ros>
129
        <remapping>joint_states:=joint_states</remapping>
130
      </ros>
131
      <update_rate>30</update_rate>
132
      <joint_name>base_to_wheel_1</joint_name>
133
      <joint_name>base_to_wheel_-1</joint_name>
134
    </plugin>
135
  </gazebo>
136

137
  <!-- 激光传感器 -->
138
  <gazebo reference="lidar_link">
139
    <sensor type="gpu_ray" name="lidar_sensor">
140
      <always_on>true</always_on>
141
      <update_rate>10</update_rate>
142
      <visualize>true</visualize>
143
      <plugin filename="libgazebo_ros_gpu_laser.so" name="lidar_plugin">
144
        <ros>
145
          <remapping>scan:=scan</remapping>
146
        </ros>
147
        <frame_name>lidar_link</frame_name>
148
        <min_range>0.12</min_range>
149
        <max_range>10.0</max_range>
150
        <update_rate>10</update_rate>
151
      </plugin>
152
      <ray>
153
        <scan>
154
          <horizontal>
155
            <samples>360</samples>
156
            <resolution>1</resolution>
157
            <min_angle>-3.14159265</min_angle>
158
            <max_angle>3.14159265</max_angle>
159
          </horizontal>
160
        </scan>
161
        <range>
162
          <min>0.12</min>
163
          <max>10.0</max>
164
          <resolution>0.01</resolution>
165
        </range>
166
      </ray>
167
    </sensor>
168
  </gazebo>
169

170
  <!-- IMU 传感器 -->
171
  <gazebo reference="imu_link">
172
    <sensor type="imu" name="imu_sensor">
173
      <always_on>true</always_on>
174
      <update_rate>100</update_rate>
175
      <visualize>false</visualize>
176
      <plugin filename="libgazebo_ros_imu.so" name="imu_plugin">
177
        <ros>
178
          <remapping>imu/data:=imu/data</remapping>
179
        </ros>
180
        <initial_orientation_as_reference>false</initial_orientation_as_reference>
181
        <update_rate>100</update_rate>
182
      </plugin>
183
    </sensor>
184
  </gazebo>
185

186
</robot>

2.2 语法检查

1
# 展开并检查
2
xacro demo_car.xacro | check_urdf
3
# 应输出 root Link: base_link 有 4 个 child：wheel_1、wheel_-1、lidar_link、imu_link

三、世界文件：建图专用迷宫

3.1 my_world.world

为 SLAM 建图准备一个有墙的世界：

1
<?xml version="1.0"?>
2
<sdf version="1.6">
3
  <world name="my_world">
4
    <include>
5
      <uri>model://sun</uri>
6
    </include>
7
    <include>
8
      <uri>model://ground_plane</uri>
9
    </include>
10

11
    <!-- 四面墙 + 中央障碍 -->
12
    <model name="wall_north">
13
      <static>true</static>
14
      <link name="link">
15
        <collision name="col">
16
          <geometry><box><size>4.0 0.2 0.5</size></box></geometry>
17
        </collision>
18
        <visual name="vis">
19
          <geometry><box><size>4.0 0.2 0.5</size></box></geometry>
20
          <material><ambient>0.6 0.6 0.6 1</ambient></material>
21
        </visual>
22
      </link>
23
      <pose>0 2 0.25 0 0 0</pose>
24
    </model>
25

26
    <model name="wall_south">
27
      <static>true</static>
28
      <link name="link">
29
        <collision name="col">
30
          <geometry><box><size>4.0 0.2 0.5</size></box></geometry>
31
        </collision>
32
        <visual name="vis">
33
          <geometry><box><size>4.0 0.2 0.5</size></box></geometry>
34
          <material><ambient>0.6 0.6 0.6 1</ambient></material>
35
        </visual>
36
      </link>
37
      <pose>0 -2 0.25 0 0 0</pose>
38
    </model>
39

40
    <model name="wall_east">
41
      <static>true</static>
42
      <link name="link">
43
        <collision name="col">
44
          <geometry><box><size>0.2 4.0 0.5</size></box></geometry>
45
        </collision>
46
        <visual name="vis">
47
          <geometry><box><size>0.2 4.0 0.5</size></box></geometry>
48
          <material><ambient>0.6 0.6 0.6 1</ambient></material>
49
        </visual>
50
      </link>
51
      <pose>2 0 0.25 0 0 0</pose>
52
    </model>
53

54
    <model name="wall_west">
55
      <static>true</static>
56
      <link name="link">
57
        <collision name="col">
58
          <geometry><box><size>0.2 4.0 0.5</size></box></geometry>
59
        </collision>
60
        <visual name="vis">
61
          <geometry><box><size>0.2 4.0 0.5</size></box></geometry>
62
          <material><ambient>0.6 0.6 0.6 1</ambient></material>
63
        </visual>
64
      </link>
65
      <pose>-2 0 0.25 0 0 0</pose>
66
    </model>
67

68
    <model name="obstacle_1">
69
      <static>true</static>
70
      <link name="link">
71
        <collision name="col">
72
          <geometry><box><size>0.4 0.4 0.5</size></box></geometry>
73
        </collision>
74
        <visual name="vis">
75
          <geometry><box><size>0.4 0.4 0.5</size></box></geometry>
76
          <material><ambient>0.8 0.5 0.2 1</ambient></material>
77
        </visual>
78
      </link>
79
      <pose>0.8 0.8 0.25 0 0 0</pose>
80
    </model>
81

82
    <model name="obstacle_2">
83
      <static>true</static>
84
      <link name="link">
85
        <collision name="col">
86
          <geometry><box><size>0.4 0.4 0.5</size></box></geometry>
87
        </collision>
88
        <visual name="vis">
89
          <geometry><box><size>0.4 0.4 0.5</size></box></geometry>
90
          <material><ambient>0.8 0.5 0.2 1</ambient></material>
91
        </visual>
92
      </link>
93
      <pose>-0.8 -0.8 0.25 0 0 0</pose>
94
    </model>
95

96
  </world>
97
</sdf>

3.2 检查世界

1
# 用 gazebo 直接打开验证（不跑 ROS）
2
gazebo my_world.world
3
# 应看到四面墙 + 两个橙色障碍物

四、一键启动 launch

4.1 gazebo.launch.py（仿真核心）

1
from launch import LaunchDescription
2
from launch.actions import IncludeLaunchDescription, SetEnvironmentVariable
3
from launch.launch_description_sources import PythonLaunchDescriptionSource
4
from launch_ros.actions import Node
5
from launch.substitutions import Command
6
import os
7
from ament_index_python.packages import get_package_share_directory
8

9
def generate_launch_description():
10
    pkg_bringup = get_package_share_directory('my_robot_bringup')
11
    pkg_desc = get_package_share_directory('my_robot_description')
12

13
    world = os.path.join(pkg_bringup, 'worlds', 'my_world.world')
14
    xacro_file = os.path.join(pkg_desc, 'urdf', 'demo_car.xacro')
15

16
    gazebo = IncludeLaunchDescription(
17
        PythonLaunchDescriptionSource(
18
            os.path.join(get_package_share_directory('gazebo_ros'),
19
                         'launch', 'gazebo.launch.py')),
20
        launch_arguments={'world': world}.items())
21

22
    robot_state_publisher = Node(
23
        package='robot_state_publisher',
24
        executable='robot_state_publisher',
25
        parameters=[{'robot_description': Command(['xacro ', xacro_file])}],
26
        output='screen')
27

28
    spawn = Node(
29
        package='gazebo_ros',
30
        executable='spawn_entity.py',
31
        arguments=['-topic', 'robot_description',
32
                   '-entity', 'demo_car',
33
                   '-x', '0', '-y', '0', '-z', '0.1'],
34
        output='screen')
35

36
    return LaunchDescription([
37
        SetEnvironmentVariable('GZ_SIM_RESOURCE_PATH',
38
                               os.path.join(pkg_desc, 'meshes')),
39
        gazebo,
40
        robot_state_publisher,
41
        spawn,
42
    ])

4.2 sim.launch.py（仿真 + RViz 一键启动）

1
from launch import LaunchDescription
2
from launch.actions import IncludeLaunchDescription
3
from launch.launch_description_sources import PythonLaunchDescriptionSource
4
from launch_ros.actions import Node
5
import os
6
from ament_index_python.packages import get_package_share_directory
7

8
def generate_launch_description():
9
    gazebo_launch = IncludeLaunchDescription(
10
        PythonLaunchDescriptionSource(
11
            os.path.join(get_package_share_directory('my_robot_bringup'),
12
                         'launch', 'gazebo.launch.py')))
13

14
    rviz = Node(
15
        package='rviz2',
16
        executable='rviz2',
17
        arguments=['-d', os.path.join(
18
            get_package_share_directory('my_robot_bringup'),
19
            'config', 'sim.rviz')],
20
        output='screen')
21

22
    return LaunchDescription([gazebo_launch, rviz])

4.3 编译并运行

1
cd ~/my_robot_ws
2
colcon build --symlink-install
3
source install/setup.bash
4

5
# 一键启动仿真 + RViz
6
ros2 launch my_robot_bringup sim.launch.py

五、全链路验收清单

5.1 话题检查

1
ros2 topic list
2
# 预期：
3
# /clock           仿真时钟
4
# /cmd_vel         速度指令
5
# /imu/data        IMU 数据
6
# /joint_states    关节状态
7
# /odom            里程计
8
# /robot_description
9
# /scan            激光
10
# /tf /tf_static

5.2 数据检查

1
# 激光有数据（rate ≈ 10Hz）
2
ros2 topic hz /scan
3

4
# IMU 有数据（rate ≈ 100Hz）
5
ros2 topic hz /imu/data
6

7
# TF 树完整：world -> odom -> base_link -> lidar_link/imu_link/wheel_*
8
ros2 run tf2_ros tf2_echo base_link lidar_link

5.3 RViz 可视化检查

RViz 添加：

RobotModel：小车模型（蓝底盘、黑轮、红雷达）。
TF：坐标系树（确认 odom 在，且随车移动）。
LaserScan（topic /scan）：看到墙的轮廓。
PointCloud2 或 Image（如配置了相机）。

5.4 运动测试

1
# 键盘控制小车跑一圈
2
ros2 run teleop_twist_keyboard teleop_twist_keyboard
3
# 按 i 前进——RViz 里激光轮廓随车移动，odom 位置变化，TF 树更新

六、常见问题与排障

现象	原因	解决
`launch 找不到 urdf/world`	未安装目录	CMake `install(DIRECTORY urdf ...)`，重新 colcon build
`spawn_entity` 找不到模型	robot_description 空	单独 `ros2 param get /robot_state_publisher robot_description`
激光 /scan 无数据	插件没加载或 reference 错	`gazebo --verbose` 看日志；核对 `reference="lidar_link"`
TF 缺 odom	diff_drive 插件没跑	检查插件是否在 xacro 里、joint 名是否匹配
RViz 里车在抖动	物理步长或 odom 频率不匹配	`max_step_size=0.001`；diff_drive `update_rate=30`
车被弹飞	模型与地面穿插	spawn `-z` 抬到 0.1 以上
`use_sim_time` 警告	部分节点没开仿真时间	导航/感知节点统一 `use_sim_time:=true`
Gazebo 卡死/黑屏	GPU 或显示问题	`gazebo --verbose`；或 headless 模式

6.1 常用调试三板斧

1
# 1. 看完整日志
2
ros2 launch my_robot_bringup sim.launch.py --verbose
3

4
# 2. 看 TF 树图
5
ros2 run tf2_tools view_frames  # 生成 frames.pdf
6

7
# 3. 单项验证（跳过 RViz）
8
ros2 launch my_robot_bringup gazebo.launch.py

七、小结与下一篇预告

本篇核心：

工程规范：description（模型）+ bringup（系统）双包结构，CMake 安装目录。
整合 Xacro：属性+宏+传感器+插件全家桶，一个文件搞定整台仿真车。
世界构建：SDF 迷宫（四面墙+障碍物），为 SLAM 建图备好场景。
一键启动：sim.launch.py = Gazebo + robot_state_publisher + spawn + RViz。
验收清单：话题、数据频率、TF 树、RViz 显示、运动测试五步闭环。
从此拥有可复用的仿真小车，后续阶段直接复用。

下一篇开启 Nav2 导航阶段（第 21 篇）：SLAM 建图（slam_toolbox）。现在小车有了模型、物理、传感器、里程计——是时候让它“认识”环境了。用 slam_toolbox 控制小车走一圈，激光+里程计融合生成地图，为 AMCL 定位和 Nav2 自主导航铺路。建模仿真阶段收官，自主移动阶段开启。