4、机器人建模与仿真：URDF模型构建、xacro优化、Gazebo物理仿真环境搭建、传感器仿真
各位同学，欢迎来到第四章。这一章，我们要亲手给机器人“造个身体”。
你想想看，算法写得再漂亮，没有模型去跑，那就是纸上谈兵。我个人习惯是，在写任何导航或探索代码之前，先把仿真环境搭好。为什么？因为真机调试一次的成本太高了，撞一次墙可能几百块就没了。而在Gazebo里，随便撞，重启一下就好。
4.1 URDF模型构建：从零开始搭积木
URDF，全称是Unified Robot Description Format。说白了，就是用XML语言描述你的机器人长什么样，有几个轮子，关节怎么转。
我记得刚入行那会儿，看着URDF文件里一堆和
核心要素：
- link（连杆）：机器人的刚体部分，比如底盘、轮子、摄像头支架。每个link要有视觉（visual）、碰撞（collision）和惯性（inertial）属性。
- joint（关节）：连接两个link的纽带。常见类型有fixed（固定）、revolute（旋转）、continuous（连续旋转）、prismatic（滑动）。
来看一个最简单的底盘模型示例：
<robot name="my_robot">
<link name="base_link">
<visual>
<geometry>
<cylinder length="0.15" radius="0.20"/>
</geometry>
<material name="blue">
<color rgba="0 0 0.8 1"/>
</material>
</visual>
<collision>
<geometry>
<cylinder length="0.15" radius="0.20"/>
</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>避坑指南：我曾经在项目里忘记写inertial标签，结果机器人一进Gazebo就原地起飞。物理引擎需要惯性参数来计算动力学，缺了它，仿真就崩了。
4.2 xacro优化：告别重复劳动
写几个link还好，要是写一个六轴机械臂，URDF文件能上千行。这时候，xacro就派上用场了。
xacro是URDF的宏定义工具。它允许你定义变量、写循环、做数学运算。说白了，就是给URDF加了个“预处理”功能。
我个人最常用的技巧：
- 定义常量：把轮子半径、底盘长度这些参数提取出来，改一个地方，全模型更新。
- 使用宏：比如写一个轮子宏，左右轮子调用同一个宏，传入不同参数即可。
- 数学运算：xacro支持简单的加减乘除，方便计算关节位置。
<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="my_robot">
<xacro:property name="wheel_radius" value="0.05"/>
<xacro:property name="wheel_length" value="0.03"/>
<xacro:macro name="wheel" params="name prefix">
<link name="${prefix}_${name}_link">
<visual>
<geometry>
<cylinder length="${wheel_length}" radius="${wheel_radius}"/>
</geometry>
</visual>
</link>
</xacro:macro>
<xacro:wheel name="left" prefix="front"/>
<xacro:wheel name="right" prefix="front"/>
</robot>经验之谈：我建议所有项目都用xacro。哪怕你只有两个轮子，也值得用。因为后期加传感器、改尺寸是家常便饭。用xacro，改一行参数就行。
4.3 Gazebo物理仿真环境搭建
模型建好了，得找个地方跑起来。Gazebo就是ROS生态里最常用的物理仿真器。
搭建Gazebo环境，核心就三步：
- 添加Gazebo插件：在URDF里加入<gazebo>标签，告诉Gazebo这个link的摩擦系数、阻尼等物理属性。
- 配置控制器：比如差速驱动，需要加载diff_drive_controller插件。
- 启动世界：写一个launch文件，加载你的机器人模型到Gazebo空世界中。
嗯，这里要注意。Gazebo的物理参数和真实世界是有差距的。我曾经在仿真里调好的PID参数，放到真机上完全不能用。原因就是仿真里的摩擦、惯量都是理想值。
警告：不要过度依赖仿真参数。仿真只能验证逻辑正确性，不能替代真机调试。我见过太多同学仿真跑得飞起，真机一动就翻车。
4.4 传感器仿真：给机器人装上“眼睛”
没有传感器的机器人，就是个瞎子。在Gazebo里，我们可以仿真激光雷达、摄像头、IMU等常见传感器。
以激光雷达为例，你需要做两件事：
- 在URDF里添加雷达link和joint，定义安装位置。
- 在Gazebo插件里配置雷达参数，比如扫描角度、分辨率、最大距离。
<gazebo reference="laser_link">
<sensor type="ray" name="head_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.10</min>
<max>10.0</max>
<resolution>0.01</resolution>
</range>
</ray>
</sensor>
</gazebo>小技巧：调试传感器时，把<visualize>设为true，可以在Gazebo里看到激光射线。这样能直观判断雷达安装角度对不对，有没有被遮挡。
摄像头仿真也类似，需要配置图像分辨率、帧率、噪声模型。我个人习惯先跑通雷达，再加摄像头。因为自主探索主要依赖激光雷达做SLAM和路径规划，摄像头更多用于目标识别。
4.5 本章小结
这一章，我们从零开始，走完了机器人建模到仿真的全流程：
- 用URDF搭积木，定义机器人的身体
- 用xacro优化，让模型可维护、可复用
- 在Gazebo里搭建物理环境，让模型动起来
- 添加传感器仿真，给机器人装上感知能力
下一章，我们会让这个仿真机器人真正跑起来，开始自主探索。到时候你会发现，今天搭的模型，就是未来所有算法的基础。所以，别偷懒，把模型调好。
有什么问题，欢迎在课程群里交流。咱们下章见。