从零搭建ROS移动机器人：Gazebo仿真+ros_control实现差速控制完整流程-CSDN博客

从零搭建ROS移动机器人：Gazebo仿真+ros_control实现差速控制完整流程

你是否曾对机器人仿真感到好奇，想亲手搭建一个能在虚拟世界里自由移动的机器人，却又被URDF、Gazebo插件和控制器配置这些环节卡住？很多开发者都有过类似的经历：跟着教程一步步操作，模型加载出来了，但轮子就是不转，或者机器人一启动就“抽搐”甚至翻倒。这背后往往不是代码逻辑错误，而是对机器人物理仿真和控制系统集成的理解不够深入。

这篇文章就是为你准备的。我们将抛开那些零散的代码片段，从一个完整的项目视角出发，带你走通从机器人建模、仿真环境搭建到实现精准运动控制的每一个关键步骤。无论你是想为后续的导航算法开发一个可靠的测试平台，还是单纯想深入理解ROS中机器人仿真的核心机制，这个流程都将为你提供一个坚实、可复用的基础。我们会重点关注如何让一个两轮差速驱动机器人在Gazebo中“活”起来，并响应你的速度指令，这其中涉及到的关节定义、传动配置、控制器参数调校，每一个细节都至关重要。

1. 项目蓝图：理解仿真机器人的核心架构

在动手写第一行代码之前，我们需要在脑海中构建出整个仿真系统的蓝图。一个能在Gazebo中受控运动的机器人，远不止一个3D模型那么简单。它是由多个逻辑层次紧密耦合而成的系统。

最底层是机器人描述，即URDF/Xacro文件。它定义了机器人的“骨骼”和“关节”——哪些是连杆，哪些是轮子，它们如何连接，质量、惯性等物理属性是什么。这一层决定了机器人的静态外观和基础动力学特性。

中间层是仿真接口与传动。Gazebo作为一个物理引擎，需要知道如何驱动URDF中定义的关节。这就是<transmission>标签和Gazebo插件的作用。<transmission>将物理关节与ROS控制接口（如hardware_interface/VelocityJointInterface）绑定，而Gazebo插件（如libgazebo_ros_diff_drive.so）则充当了ROS控制器与Gazebo内部物理关节之间的翻译官和驱动器。

最上层是控制器与交互。ros_control框架提供了标准的控制器（如差速驱动控制器），这些控制器订阅/cmd_vel等话题，计算出每个关节应有的速度或位置指令，通过中间层最终作用到仿真模型上。同时，控制器还会发布/odom里程计信息，形成闭环。

理解这个分层架构至关重要。很多问题，比如轮子不动、里程计不准，都可以通过逐层排查来解决：描述文件是否正确？传动配置是否匹配？插件参数是否合理？控制器是否加载？接下来，我们就从最底层开始，一步步构建。

2. 机器人建模：用Xacro构建模块化与参数化的URDF

直接编写冗长的URDF文件容易出错且难以维护。Xacro（XML宏）是ROS中用于简化URDF编写的工具，它支持变量、宏和文件包含，让我们能像编程一样构建机器人模型。我们将创建一个模块化的机器人描述包。

首先，创建一个ROS工作空间和功能包：

mkdir -p ~/catkin_ws/src
cd ~/catkin_ws/src
catkin_create_pkg my_robot_description urdf xacro gazebo_ros gazebo_ros_control
cd ~/catkin_ws
catkin_make
source devel/setup.bash

我们的机器人模型将由几个Xacro文件组合而成，核心思想是“分而治之”。

2.1 定义基础宏与惯性参数

创建一个urdf/inertia.xacro文件，定义计算常见几何体惯性矩阵的宏。惯性参数对于Gazebo中的物理仿真真实性影响巨大，不正确的惯性设置会导致机器人运动轻浮或反应迟钝。

<robot name="inertia" xmlns:xacro="http://wiki.ros.org/xacro">
  <!-- 球体惯性矩阵宏 -->
  <xacro:macro name="sphere_inertial_matrix" params="m r">
    <inertial>
      <mass value="${m}" />
      <inertia ixx="${2*m*r*r/5}" ixy="0" ixz="0"
               iyy="${2*m*r*r/5}" iyz="0"
               izz="${2*m*r*r/5}" />
    </inertial>
  </xacro:macro>

  <!-- 圆柱体惯性矩阵宏 -->
  <xacro:macro name="cylinder_inertial_matrix" params="m r h">
    <inertial>
      <mass value="${m}" />
      <inertia ixx="${m*(3*r*r+h*h)/12}" ixy="0" ixz="0"
               iyy="${m*(3*r*r+h*h)/12}" iyz="0"
               izz="${m*r*r/2}" />
    </inertial>
  </xacro:macro>

  <!-- 长方体惯性矩阵宏 -->
  <xacro:macro name="box_inertial_matrix" params="m l w h">
    <inertial>
      <mass value="${m}" />
      <inertia ixx="${m*(h*h + l*l)/12}" ixy="0" ixz="0"
               iyy="${m*(w*w + l*l)/12}" iyz="0"
               izz="${m*(w*w + h*h)/12}" />
    </inertial>
  </xacro:macro>
</robot>

注意：惯性矩阵的计算公式基于标准几何体在质心处的惯性张量。对于复杂形状，可能需要CAD软件计算或进行简化近似。

2.2 构建机器人底盘与驱动轮

接下来是主体文件urdf/robot_base.xacro。这里我们设计一个简单的两轮差分驱动机器人：一个圆柱形主体，两个驱动轮，前后各一个万向支撑轮。

<robot name="robot_base" xmlns:xacro="http://www.ros.org/wiki/xacro">
  <xacro:include filename="inertia.xacro" />
  <xacro:property name="PI" value="3.1415926535"/>

  <!-- 基础尺寸与质量参数 -->
  <xacro:property name="base_radius" value="0.15" />  <!-- 底盘半径 -->
  <xacro:property name="base_height" value="0.1" />   <!-- 底盘高度 -->
  <xacro:property name="base_mass" value="2.0" />     <!-- 底盘质量 -->

  <xacro:property name="wheel_radius" value="0.05" />  <!-- 驱动轮半径 -->
  <xacro:property name="wheel_width" value="0.025" />  <!-- 驱动轮宽度 -->
  <xacro:property name="wheel_mass" value="0.3" />     <!-- 驱动轮质量 -->

  <xacro:property name="caster_radius" value="0.015" /> <!-- 支撑轮半径 -->
  <xacro:property name="caster_mass" value="0.05" />    <!-- 支撑轮质量 -->

  <!-- 1. 定义基座连杆 -->
  <link name="base_footprint">
    <visual>
      <geometry> <sphere radius="0.001"/> </geometry>
    </visual>
  </link>

  <link name="base_link">
    <visual>
      <geometry>
        <cylinder radius="${base_radius}" length="${base_height}"/>
      </geometry>
      <material name="blue"> <color rgba="0.1 0.1 0.8 1.0"/> </material>
    </visual>
    <collision>
      <geometry>
        <cylinder rad