机器人仿真基础：Gazebo与RViz2的使用、URDF模型构建、传感器仿真

一、核心原理：仿真系统如何支撑机器人开发

在真实机器人上调试算法往往受限于硬件成本、场地安全与重复实验的可行性。仿真系统通过物理引擎（如ODE、Bullet）模拟刚体动力学、碰撞响应与关节约束，同时提供传感器噪声模型与环境光照/材质属性，使算法能在接近真实的条件下先行验证。ROS2中，Gazebo负责物理世界模拟，RViz2负责数据可视化与交互，两者通过ROS2话题通信协同工作。

URDF（Unified Robot Description Format）是连接两者的桥梁——它用XML描述机器人的连杆、关节、惯量与碰撞属性。Gazebo读取URDF后附加传感器插件（如激光雷达、IMU），RViz2则订阅传感器话题与TF树，将机器人模型与感知数据叠加显示。理解这一数据流是仿真开发的基础：

URDF模型 → robot_state_publisher → /robot_description + /tf
         → Gazebo（加载模型 + 传感器插件）→ /scan, /imu/data
         → RViz2（订阅话题 + TF，可视化）

二、方法流程：从URDF构建到联合仿真

构建一个可仿真的机器人模型需要遵循“几何建模 → 物理属性 → 传感器集成 → 联合调试”的流程。下面以两轮差速小车为例，展示核心步骤。

2.1 编写基础URDF

URDF的核心是<link>（刚体）与<joint>（连接关系）。每个link需定义视觉网格（visual）、碰撞网格（collision）与惯性参数（inertial）。以下为简化示例：

<robot name="diff_drive">
  <link name="base_link">
    <visual>
      <geometry><box size="0.4 0.3 0.1"/></geometry>
    </visual>
    <collision>
      <geometry><box size="0.4 0.3 0.1"/></geometry>
    </collision>
    <inertial>
      <mass value="2.0"/>
      <inertia ixx="0.01" ixy="0" ixz="0" iyy="0.02" iyz="0" izz="0.01"/>
    </inertial>
  </link>

  <link name="left_wheel">
    <visual><geometry><cylinder radius="0.05" length="0.03"/></geometry></visual>
    <collision><geometry><cylinder radius="0.05" length="0.03"/></geometry></collision>
  </link>

  <joint name="left_wheel_joint" type="continuous">
    <parent link="base_link"/>
    <child link="left_wheel"/>
    <origin xyz="0 -0.15 0" rpy="0 1.5708 0"/>
    <axis xyz="0 0 1"/>
  </joint>
</robot>

2.2 添加Gazebo仿真扩展

在URDF文件末尾追加<gazebo>标签，为link补充摩擦系数，为joint添加传动与驱动：

<gazebo reference="base_link">
  <mu1 value="1.0"/>
  <mu2 value="1.0"/>
  <material>Gazebo/DarkGrey</material>
</gazebo>

<gazebo>
  <plugin name="diff_drive" filename="libgazebo_ros_diff_drive.so">
    <ros>
      <namespace>/demo</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>
    <command_topic>cmd_vel</command_topic>
    <odometry_topic>odom</odometry_topic>
  </plugin>
</gazebo>

2.3 启动仿真与可视化

使用launch文件同时启动Gazebo、加载URDF并运行RViz2：

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(package='gazebo_ros', executable='spawn_entity.py',
             arguments=['-topic', 'robot_description', '-entity', 'my_robot']),
        Node(package='robot_state_publisher', executable='robot_state_publisher',
             parameters=[{'robot_description': open('my_robot.urdf').read()}]),
        Node(package='rviz2', executable='rviz2',
             arguments=['-d', 'my_robot.rviz'])
    ])

三、案例/场景：传感器仿真与数据可视化

在差速小车上集成激光雷达与IMU，验证SLAM算法前的数据质量。以下为Gazebo中激光雷达插件的配置片段：

<gazebo reference="laser_link">
  <sensor type="gpu_ray" name="head_laser">
    <pose>0.1 0 0.15 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>
      <noise>
        <type>gaussian</type>
        <mean>0.0</mean>
        <stddev>0.01</stddev>
      </noise>
    </ray>
    <plugin name="laser_controller" filename="libgazebo_ros_ray_sensor.so">
      <ros><namespace>/demo</namespace></ros>
      <output_type>sensor_msgs/LaserScan</output_type>
      <frame_name>laser_link</frame_name>
    </plugin>
  </sensor>
</gazebo>

启动后，在RViz2中添加LaserScan显示，选择话题/demo/scan，即可看到激光点云。通过调整stddev参数可模拟不同精度的传感器——噪声过大会导致建图重影，过小则无法验证算法鲁棒性。

四、误区/复盘：仿真与现实的差距

误区1：URDF直接用于Gazebo就能完美仿真。实际上，URDF缺少摩擦系数、恢复系数、阻尼等物理参数，必须通过<gazebo>标签补充。否则机器人会“飘”或“打滑”。

误区2：RViz2中看到的模型就是仿真真实状态。RViz2默认显示的是URDF的视觉模型，而Gazebo计算的是碰撞模型。若两者几何不一致（如视觉网格精细但碰撞网格粗糙），会出现“视觉穿过障碍物”的假象。

误区3：传感器噪声越小越好。仿真中加入高斯噪声是为了逼近真实硬件。若完全无噪声，算法在仿真中表现优异，迁移到真实机器人时可能崩溃。建议根据目标传感器数据手册设置噪声参数。