3. XACRO优化建模：宏定义、数学表达式、文件包含、参数化设计

做机器人建模，URDF是基本功。但用久了你会发现，这东西写起来太啰嗦了。

一个六轴机械臂，每个关节的连杆形状差不多，就是尺寸和颜色不同。你非得把每个link的<geometry>、<origin>、<material>全部手敲一遍？

我刚开始带项目时，团队里有个新人就是这么干的。一个六轴臂的URDF写了800多行，改个轮子半径要搜遍全文替换。后来我让他全部换成XACRO，代码直接缩到150行。他当时看我的眼神，嗯，就像看救星。

说白了，XACRO就是URDF的「增强版」。它帮你解决三个痛点：重复代码、硬编码数值、文件碎片化。

3.1 宏定义：把重复代码「包起来」

宏是XACRO最实用的功能。没有之一。

你想想看，一个机器人身上，螺丝、轴承、支架，可能有几十个相同形状的零件。每个都写一遍？没必要。用宏定义一次，后面直接调用就行。

<!-- 定义一个轮子的宏 -->
<xacro:macro name="wheel" params="name radius width color">
  <link name="${name}">
    <visual>
      <geometry>
        <cylinder radius="${radius}" length="${width}"/>
      </geometry>
      <origin xyz="0 0 0" rpy="0 0 0"/>
      <material name="${color}">
        <color rgba="${color}"/>
      </material>
    </visual>
  </link>
</xacro:macro>

<!-- 调用宏，生成两个轮子 -->
<xacro:wheel name="left_wheel" radius="0.1" width="0.05" color="0.8 0.2 0.2 1.0"/>
<xacro:wheel name="right_wheel" radius="0.1" width="0.05" color="0.2 0.8 0.2 1.0"/>

我在项目中遇到过最典型的场景：一个AGV小车，四个轮子完全一样，只是安装位置不同。用宏定义后，改轮子半径只需要改一处。要是用原始URDF，你得改四个地方，漏一个就等着翻车吧。

3.2 数学表达式：告别计算器

URDF里所有数值都是硬编码。你想让两个连杆之间有某种几何关系？自己拿计算器算好再填进去。

XACRO支持在属性值里直接写数学表达式。用${}括起来就行。

<!-- 数学表达式示例 -->
<xacro:property name="base_height" value="0.2"/>
<xacro:property name="arm_length" value="0.5"/>

<link name="base">
  <visual>
    <geometry>
      <box size="0.3 0.3 ${base_height}"/>
    </geometry>
    <origin xyz="0 0 ${base_height/2}" rpy="0 0 0"/>
  </visual>
</link>

<joint name="base_to_arm" type="fixed">
  <parent link="base"/>
  <child link="arm"/>
  <origin xyz="0 0 ${base_height + arm_length/2}" rpy="0 0 0"/>
</joint>

支持的操作符包括：+ - * /、取模%、三角函数sin() cos()、甚至radians() degrees()。

我曾经调试一个六轴臂，末端执行器的位置总是偏一点。查了半天，发现是某个连杆的origin算错了，差了2毫米。用数学表达式后，所有位置都基于参数自动计算，再也没出过这种低级错误。

3.3 文件包含：拆开写，合着用

一个完整的机器人模型，可能有几十个零件。全塞在一个文件里？那画面太美我不敢看。

XACRO支持<xacro:include>，让你把模型拆成多个文件。每个文件负责一个部件，最后用一个主文件把它们组装起来。

<!-- 主文件 robot.xacro -->
<robot name="my_robot" xmlns:xacro="http://www.ros.org/wiki/xacro">
  <xacro:include filename="$(find my_package)/urdf/base.xacro"/>
  <xacro:include filename="$(find my_package)/urdf/arm.xacro"/>
  <xacro:include filename="$(find my_package)/urdf/gripper.xacro"/>
  
  <!-- 组装各部件 -->
  <xacro:base prefix="base"/>
  <xacro:arm prefix="arm" parent="base"/>
  <xacro:gripper prefix="gripper" parent="arm"/>
</robot>

文件包含的好处很明显：

• 模块化：每个人负责一个部件文件，互不干扰
• 复用：同一个gripper文件，可以用在多个机器人上
• 调试：哪个部件出问题，直接定位到对应文件

我建议的目录结构是这样的：

urdf/
├── robot.xacro          # 主文件
├── base.xacro           # 底盘
├── arm.xacro            # 手臂
├── gripper.xacro        # 夹爪
├── sensors/             # 传感器目录
│   ├── lidar.xacro
│   └── camera.xacro
└── materials.xacro      # 材质定义

嗯，这里要注意：$(find my_package)这种写法，要求你的包已经编译过，并且source了setup文件。否则路径解析会失败。我刚开始用的时候，经常忘了source，然后对着报错信息发呆十分钟。

3.4 参数化设计：一个模型，多种变体

参数化是XACRO的终极武器。

什么意思呢？就是同一个模型文件，通过改变参数，可以生成不同规格的机器人。比如：

<!-- 参数化机器人 -->
<xacro:property name="wheel_radius" value="0.1"/>
<xacro:property name="wheel_width" value="0.05"/>
<xacro:property name="chassis_length" value="0.4"/>
<xacro:property name="chassis_width" value="0.3"/>

<!-- 所有几何尺寸都基于这些参数计算 -->
<link name="chassis">
  <visual>
    <geometry>
      <box size="${chassis_length} ${chassis_width} 0.1"/>
    </geometry>
  </visual>
</link>

更高级的用法，是通过命令行传参：

# 生成不同尺寸的机器人
rosrun xacro xacro robot.xacro wheel_radius:=0.15 > robot_large.urdf
rosrun xacro xacro robot.xacro wheel_radius:=0.08 > robot_small.urdf

我在做教育机器人项目时，需要同时支持三种尺寸的底盘。用参数化设计，一个XACRO文件搞定。改参数、重新生成URDF、重启Gazebo，整个过程不到30秒。要是用原始URDF，我得维护三个独立的文件，改一个地方要同步改另外两个，想想就头疼。

3.5 知识体系总览

下面这张图，是我对XACRO优化建模的总结。你可以把它当作一个「速查地图」：

3.6 避坑指南

最后，分享几个我踩过的坑：

• 宏的递归调用：XACRO不支持宏递归调用。别想着写一个宏自己调自己，解析器会直接崩溃。我试过，嗯，结果就是终端里一堆看不懂的报错。
• 属性覆盖：同一个<xacro:property>如果定义了两次，后面的会覆盖前面的。我曾经在包含的文件里重新定义了主文件的参数，导致整个模型尺寸全变了。排查了半小时才发现。
• 路径问题：$(find my_package)在launch文件里好用，但在纯命令行里可能找不到。建议用rosrun xacro xacro '$(find my_package)/urdf/robot.xacro'这种写法。
• 命名冲突：不同文件里的宏如果同名，后面的会覆盖前面的。我建议给宏名加前缀，比如base_wheel、arm_wheel，避免冲突。

好了，XACRO的核心内容就这些。说白了，它就是URDF的「语法糖」，但甜得恰到好处。用好了，你的建模效率能翻倍，代码质量也能上一个台阶。