ROS2 Humble + Gazebo 11 保姆级教程：从零搭建一个能跑能停的差分AGV模型

ROS2 Humble + Gazebo 11 实战指南：从零构建可自主导航的差分AGV

在机器人开发领域，仿真环境的重要性不言而喻。它不仅能大幅降低硬件成本，还能加速算法验证和系统调试的迭代周期。ROS2与Gazebo的组合，正成为现代机器人开发者不可或缺的工具链。本文将带你从零开始，构建一个完整的差分驱动AGV（自动导引车）仿真系统，涵盖模型创建、物理仿真、运动控制等关键环节。

1. 开发环境准备与基础配置

1.1 系统与软件要求

在开始之前，请确保你的系统满足以下最低要求：

• 操作系统：Ubuntu 22.04 LTS（推荐）或20.04 LTS
• ROS2版本：Humble Hawksbill（长期支持版）
• Gazebo版本：Gazebo Fortress或Classic 11（本文基于11版本）

安装基础环境：

sudo apt update sudo apt install -y ros-humble-desktop ros-humble-gazebo-ros-pkgs

验证安装：

source /opt/ros/humble/setup.bash ros2 run gazebo_ros gazebo --version

1.2 创建工作空间与功能包

创建一个独立的工作空间有助于项目管理：

mkdir -p ~/agv_ws/src cd ~/agv_ws/src ros2 pkg create --build-type ament_cmake agv_simulation \ --dependencies rclcpp gazebo_ros_pkgs geometry_msgs

目录结构建议如下：

agv_simulation/ ├── config/ # 配置文件 ├── launch/ # 启动文件 ├── meshes/ # 3D模型文件 ├── models/ # Gazebo模型 ├── scripts/ # Python脚本 ├── urdf/ # URDF/Xacro文件 ├── CMakeLists.txt └── package.xml

提示：在package.xml中添加以下依赖项确保功能完整：

<depend>robot_state_publisher</depend> <depend>joint_state_publisher</depend> <depend>xacro</depend>

2. AGV机械模型构建

2.1 Xacro模型定义基础

Xacro（XML宏）是ROS中用于简化URDF编写的工具。我们首先定义差分AGV的基本结构：

<!-- agv_simulation/urdf/agv.xacro --> <robot name="diff_agv" xmlns:xacro="http://www.ros.org/wiki/xacro"> <!-- 材料定义 --> <material name="blue"> <color rgba="0 0 0.8 1"/> </material> <material name="black"> <color rgba="0.1 0.1 0.1 1"/> </material> <!-- 基础链接 --> <link name="base_link"> <visual> <geometry> <box size="0.4 0.2 0.1"/> </geometry> <material name="blue"/> </visual> <collision> <geometry> <box size="0.4 0.2 0.1"/> </geometry> </collision> <inertial> <mass value="5.0"/> <inertia ixx="0.1" ixy="0" ixz="0" iyy="0.1" iyz="0" izz="0.1"/> </inertial> </link> </robot>

2.2 完整差分驱动结构

扩展模型包含驱动轮和万向轮：

<!-- 左驱动轮 --> <link name="left_wheel"> <visual> <geometry> <cylinder radius="0.05" length="0.03"/> </geometry> <material name="black"/> </visual> <collision> <geometry> <cylinder radius="0.05" length="0.03"/> </geometry> </collision> <inertial> <mass value="0.5"/> <inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.002"/> </inertial> </link> <joint name="left_wheel_joint" type="continuous"> <parent link="base_link"/> <child link="left_wheel"/> <origin xyz="0 0.15 -0.05" rpy="1.5708 0 0"/> <axis xyz="0 1 0"/> </joint> <!-- 右驱动轮（与左轮对称） --> <link name="right_wheel"> <!-- 类似左轮的定义 --> </link> <joint name="right_wheel_joint" type="continuous"> <!-- 类似左轮关节 --> </joint> <!-- 万向轮 --> <link name="caster_wheel"> <visual> <geometry> <sphere radius="0.03"/> </geometry> <material name="black"/> </visual> <collision> <geometry> <sphere radius="0.03"/> </geometry> </collision> <inertial> <mass value="0.2"/> <inertia ixx="0.0001" ixy="0" ixz="0" iyy="0.0001" iyz="0" izz="0.0001"/> </inertial> </link> <joint name="caster_joint" type="fixed"> <parent link="base_link"/> <child link="caster_wheel"/> <origin xyz="-0.15 0 -0.05"/> </joint>

2.3 模型验证与调试

使用RViz进行可视化验证：

ros2 launch agv_simulation display.launch.py

常见问题排查：

• 模型不显示：检查URDF转换是否正确xacro agv.xacro > agv.urdf
• 关节异常：验证joint_state_publisher是否正常运行
• 颜色丢失：确保material定义正确且RViz配置中"RobotModel"的"Alpha"值不为0

3. Gazebo仿真集成

3.1 Gazebo插件配置

要让模型在Gazebo中具有物理特性，需要添加Gazebo标签：

<!-- 在xacro文件中添加 --> <gazebo reference="base_link"> <material>Gazebo/Blue</material> </gazebo> <gazebo reference="left_wheel"> <mu1 value="1.0"/> <mu2 value="1.0"/> <material>Gazebo/Black</material> </gazebo> <!-- 类似配置其他链接 -->

3.2 差分驱动插件

核心驱动配置：

<gazebo> <plugin name="diff_drive" filename="libgazebo_ros_diff_drive.so"> <ros> <namespace>/agv</namespace> </ros> <left_joint>left_wheel_joint</left_joint> <right_joint>right_wheel_joint</right_joint> <wheel_separation>0.3</wheel_separation> <wheel_diameter>0.1</wheel_diameter> <max_wheel_torque>20</max_wheel_torque> <max_wheel_acceleration>5.0</max_wheel_acceleration> <command_topic>cmd_vel</command_topic> <odometry_topic>odom</odometry_topic> <odometry_frame>odom</odometry_frame> <robot_base_frame>base_link</robot_base_frame> </plugin> </gazebo>

关键参数说明：

3.3 启动Gazebo世界

创建启动文件agv_simulation/launch/gazebo.launch.py：

from launch import LaunchDescription from launch_ros.actions import Node from launch.actions import ExecuteProcess def generate_launch_description(): return LaunchDescription([ ExecuteProcess( cmd=['gazebo', '--verbose', '-s', 'libgazebo_ros_init.so'], output='screen' ), Node( package='gazebo_ros', executable='spawn_entity.py', arguments=['-topic', 'robot_description', '-entity', 'agv'], output='screen' ) ])

4. 运动控制实现

4.1 键盘控制测试

使用ROS2内置的键盘控制节点：

ros2 run teleop_twist_keyboard teleop_twist_keyboard \ --ros-args -r /cmd_vel:=/agv/cmd_vel

控制命令对照表：

4.2 自主导航基础

实现简单的点到点控制：

# agv_simulation/scripts/nav_controller.py import rclpy from rclpy.node import Node from geometry_msgs.msg import Twist from nav_msgs.msg import Odometry import math class AGVController(Node): def __init__(self): super().__init__('agv_controller') self.cmd_pub = self.create_publisher(Twist, '/agv/cmd_vel', 10) self.odom_sub = self.create_subscription( Odometry, '/agv/odom', self.odom_callback, 10) # 目标位置 [x, y, theta] self.target = [2.0, 1.5, 0.0] self.current_pose = [0.0, 0.0, 0.0] # 控制参数 self.linear_tolerance = 0.05 self.angular_tolerance = 0.1 self.max_linear_speed = 0.5 self.max_angular_speed = 1.0 self.timer = self.create_timer(0.1, self.control_loop) def odom_callback(self, msg): # 提取当前位置和朝向 self.current_pose[0] = msg.pose.pose.position.x self.current_pose[1] = msg.pose.pose.position.y # 从四元数转换到欧拉角（仅需偏航角） q = msg.pose.pose.orientation siny_cosp = 2 * (q.w * q.z + q.x * q.y) cosy_cosp = 1 - 2 * (q.y * q.y + q.z * q.z) self.current_pose[2] = math.atan2(siny_cosp, cosy_cosp) def control_loop(self): cmd = Twist() # 计算位置误差 dx = self.target[0] - self.current_pose[0] dy = self.target[1] - self.current_pose[1] distance = math.sqrt(dx**2 + dy**2) # 计算目标角度 target_angle = math.atan2(dy, dx) angle_error = target_angle - self.current_pose[2] # 角度归一化到[-π, π] if angle_error > math.pi: angle_error -= 2 * math.pi elif angle_error < -math.pi: angle_error += 2 * math.pi # 控制逻辑 if distance > self.linear_tolerance: if abs(angle_error) > self.angular_tolerance: # 先调整方向 cmd.angular.z = self.max_angular_speed * (1.0 if angle_error > 0 else -1.0) else: # 直线前进 cmd.linear.x = min(self.max_linear_speed, distance * 0.5) else: # 到达目标位置 self.get_logger().info("Target reached!") cmd.linear.x = 0.0 cmd.angular.z = 0.0 self.cmd_pub.publish(cmd) def main(args=None): rclpy.init(args=args) controller = AGVController() rclpy.spin(controller) controller.destroy_node() rclpy.shutdown() if __name__ == '__main__': main()

4.3 高级功能扩展

4.3.1 添加激光雷达仿真

在xacro中添加Hokuyo激光雷达模型：

<link name="laser_link"> <visual> <geometry> <box size="0.05 0.05 0.05"/> </geometry> </visual> <collision> <geometry> <box size="0.05 0.05 0.05"/> </geometry> </collision> <inertial> <mass value="0.1"/> <inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.001"/> </inertial> </link> <joint name="laser_joint" type="fixed"> <parent link="base_link"/> <child link="laser_link"/> <origin xyz="0.2 0 0.1" rpy="0 0 0"/> </joint> <gazebo reference="laser_link"> <sensor type="ray" name="laser"> <pose>0 0 0 0 0 0</pose> <visualize>true</visualize> <update_rate>10</update_rate> <ray> <scan> <horizontal> <samples>360</samples> <resolution>1</resolution> <min_angle>-3.14159</min_angle> <max_angle>3.14159</max_angle> </horizontal> </scan> <range> <min>0.1</min> <max>10.0</max> <resolution>0.01</resolution> </range> </ray> <plugin name="laser_controller" filename="libgazebo_ros_ray_sensor.so"> <ros> <namespace>/agv</namespace> </ros> <output_type>sensor_msgs/msg/LaserScan</output_type> <frame_name>laser_link</frame_name> </plugin> </sensor> </gazebo>

4.3.2 添加IMU传感器

<gazebo reference="base_link"> <sensor type="imu" name="imu_sensor"> <plugin filename="libgazebo_ros_imu_sensor.so" name="imu_plugin"> <ros> <namespace>/agv</namespace> </ros> <frame_name>base_link</frame_name> </plugin> </sensor> </gazebo>

5. 调试技巧与性能优化

5.1 常见问题解决方案

问题1：模型在Gazebo中下坠或漂浮

• 检查所有链接的inertial标签是否正确定义
• 验证质量(mass)和惯性矩(inertia)值是否合理
• 确保重力参数正确（默认应为9.8 m/s²）

问题2：差分驱动无响应

• 确认插件名称正确：libgazebo_ros_diff_drive.so
• 检查关节名称是否与URDF中定义一致
• 使用ros2 topic echo /agv/odom验证odometry数据

问题3：模型颜色不显示

• 在xacro中同时定义<material>和<gazebo>标签
• 检查Gazebo客户端的图形设置

5.2 性能优化建议

1. 简化碰撞模型：

   • 使用基本几何体代替复杂mesh
   • 减少碰撞体数量

2. 调整物理参数：

   <gazebo> <physics type="ode"> <max_step_size>0.001</max_step_size> <real_time_update_rate>1000</real_time_update_rate> </physics> </gazebo>

3. 优化传感器更新率：

   • 根据实际需要调整激光雷达/IMU的update_rate
   • 非必要时不启用visualize选项

5.3 可视化调试工具

推荐工具组合：

• RViz2：查看TF树、传感器数据
• PlotJuggler：分析话题数据时序
• rqt_graph：查看节点通信关系
• ros2 topic hz：监测话题发布频率

# 查看TF树 ros2 run tf2_tools view_frames.py # 监测话题频率 ros2 topic hz /agv/odom