保姆级教程：用ROS2 Humble + Gazebo Classic 从零搭建一个能键盘控制的差分AGV模型

从零构建ROS2差分AGV模型搭建、Gazebo仿真与键盘控制实战指南刚接触ROS2时最令人头疼的莫过于那些看似简单却暗藏玄机的机器人仿真环节。你是否也曾在深夜盯着Gazebo里纹丝不动的小车模型反复检查URDF文件却找不到问题所在本文将带你完整走一遍差分驱动机器人AGV从建模到控制的全部流程重点解决那些官方文档没讲清楚的坑点。1. 环境准备与工作空间配置在开始之前确保你的系统已经安装ROS2 Humble版本。建议使用Ubuntu 22.04 LTS作为开发环境这是目前对ROS2 Humble支持最稳定的系统版本。不同于ROS1ROS2的构建系统采用了更现代的ament工具链这也是我们后续配置时需要特别注意的点。创建工作空间的步骤看似简单但有几个关键细节容易出错mkdir -p ~/agv_ws/src cd ~/agv_ws colcon build --symlink-install--symlink-install参数允许你在修改源代码后无需重新安装即可生效这对频繁调试的开发阶段非常有用。接下来创建功能包时我们需要明确区分不同功能的包cd src ros2 pkg create --build-type ament_cmake agv_description ros2 pkg create --build-type ament_python agv_control注意描述性内容如URDF/Xacro文件通常放在ament_cmake包中而控制逻辑更适合用ament_python包。这种分离符合ROS2的模块化设计理念。2. 差分机器人模型构建实战2.1 Xacro文件结构设计差分机器人的核心在于两个驱动轮和一个或多个支撑轮的设计。在Xacro文件中我们需要明确定义以下几个部分!-- agv.urdf.xacro -- robot nameagv xmlns:xacrohttp://www.ros.org/wiki/xacro !-- 材料定义 -- material nameblue color rgba0 0 0.8 1/ /material !-- 基础链接 -- link namebase_link visual geometry box size0.4 0.2 0.1/ /geometry material nameblue/ /visual collision geometry box size0.4 0.2 0.1/ /geometry /collision inertial mass value5.0/ inertia ixx0.1 ixy0 ixz0 iyy0.1 iyz0 izz0.1/ /inertial /link !-- 左轮 -- link nameleft_wheel !-- 轮子定义细节 -- /link joint nameleft_wheel_joint typecontinuous parent linkbase_link/ child linkleft_wheel/ origin xyz0 0.15 -0.05 rpy0 1.57 0/ axis xyz0 1 0/ /joint !-- 右轮和支撑轮类似定义 -- /robot2.2 常见建模问题排查在模型构建过程中最容易出现的问题集中在以下几个方面惯性参数错误Gazebo仿真需要正确的质量(mass)和惯性矩(inertia)参数否则会导致物理仿真异常关节类型混淆驱动轮应使用continuous类型关节而非revolute坐标系方向不一致轮子的旋转轴(y轴)应与前进方向垂直使用以下命令检查模型是否正确加载ros2 launch agv_description display.launch.py如果RViz中看不到模型首先检查是否在package.xml中正确声明了依赖(urdf, xacro)launch文件中是否正确设置了路径参数模型文件是否有语法错误可使用check_urdf命令验证3. Gazebo仿真集成详解3.1 Gazebo插件配置让模型在Gazebo中动起来的关键是正确配置差分驱动插件。以下是一个经过验证的参数配置gazebo plugin namediff_drive filenamelibgazebo_ros_diff_drive.so ros namespace/agv/namespace /ros left_jointleft_wheel_joint/left_joint right_jointright_wheel_joint/right_joint wheel_separation0.3/wheel_separation wheel_diameter0.1/wheel_diameter max_wheel_torque20/max_wheel_torque max_wheel_acceleration1.0/max_wheel_acceleration command_topiccmd_vel/command_topic odometry_topicodom/odometry_topic odometry_frameodom/odometry_frame robot_base_framebase_link/robot_base_frame /plugin /gazebo关键提示wheel_separation值必须与模型中两轮的实际距离一致否则会导致运动控制不准确。3.2 启动文件配置技巧一个完整的Gazebo启动文件应该包含以下关键组件# car_gazebo.launch.py from launch import LaunchDescription from launch_ros.actions import Node from launch.actions import IncludeLaunchDescription from launch.launch_description_sources import PythonLaunchDescriptionSource import os from ament_index_python.packages import get_package_share_directory def generate_launch_description(): pkg_path get_package_share_directory(agv_description) gazebo IncludeLaunchDescription( PythonLaunchDescriptionSource([ os.path.join(get_package_share_directory(gazebo_ros), launch, gazebo.launch.py) ]) ) spawn_entity Node( packagegazebo_ros, executablespawn_entity.py, arguments[-topic, robot_description, -entity, agv], outputscreen ) robot_state_publisher Node( packagerobot_state_publisher, executablerobot_state_publisher, namerobot_state_publisher, outputscreen, parameters[{use_sim_time: True}] ) return LaunchDescription([ gazebo, robot_state_publisher, spawn_entity, ])4. 键盘控制与运动测试4.1 teleop_twist_keyboard适配ROS2自带的键盘控制节点需要稍作调整才能与我们的AGV配合工作ros2 run teleop_twist_keyboard teleop_twist_keyboard \ --ros-args -r /cmd_vel:/agv/cmd_vel如果发现控制方向相反检查插件中左右轮关节名称是否正确对应轮子的旋转轴方向是否一致键盘映射是否正确可通过ros2 topic echo /agv/cmd_vel验证4.2 运动调试技巧当AGV运动不稳定时可以尝试以下调整降低最大加速度max_wheel_acceleration0.5/max_wheel_acceleration增加支撑轮摩擦gazebo referencecaster_wheel mu10.5/mu1 mu20.5/mu2 /gazebo调整控制频率# 在控制节点中增加发布频率限制 self.create_timer(0.1, self.control_callback)5. 进阶从键盘控制到自主导航完成基础控制后可以尝试为AGV添加简单的自主移动能力。以下是一个获取里程计信息并实现定点移动的示例# agv_navigator.py import rclpy from rclpy.node import Node from nav_msgs.msg import Odometry from geometry_msgs.msg import Twist, Point import math class AGVNavigator(Node): def __init__(self): super().__init__(agv_navigator) self.odom_sub self.create_subscription( Odometry, /agv/odom, self.odom_callback, 10) self.cmd_pub self.create_publisher(Twist, /agv/cmd_vel, 10) self.target Point(x2.0, y1.5) # 目标位置 self.current_pose None def odom_callback(self, msg): self.current_pose msg.pose.pose self.move_to_target() def move_to_target(self): if self.current_pose is None: return dx self.target.x - self.current_pose.position.x dy self.target.y - self.current_pose.position.y distance math.sqrt(dx**2 dy**2) cmd Twist() if distance 0.1: # 距离阈值 # 简单P控制 cmd.linear.x min(0.5, distance * 0.5) # 计算朝向角 target_yaw math.atan2(dy, dx) # 获取当前朝向需要从四元数转换 # ... 省略四元数转换部分 ... cmd.angular.z 0.5 * (target_yaw - current_yaw) else: cmd.linear.x 0.0 cmd.angular.z 0.0 self.cmd_pub.publish(cmd)在实际项目中我们通常会遇到Gazebo仿真时间与实际时间不同步的问题。这时可以在launch文件中添加use_sim_time参数Node( packageagv_control, executableagv_navigator, nameagv_navigator, outputscreen, parameters[{use_sim_time: True}] )