4. XACRO优化与宏定义：让URDF从“手写代码”变成“工程利器”
各位同学，欢迎来到第四章。前几章我们手写URDF，是不是感觉有点“原始”？一个简单的机械臂，关节一多，代码就变得又臭又长。我记得我第一次给一个六轴协作臂写URDF，光复制粘贴连杆参数就花了半天，改一个尺寸还得满世界找……嗯，那感觉，就像在玩“大家来找茬”。
这一章，我们就来解决这个问题。主角就是 XACRO——URDF的“升级版”。说白了，它就是一个预处理器，让你能用宏、变量、数学运算来写机器人模型。你想想看，这就像从“手写汇编”升级到了“用C语言”，效率提升不是一点半点。
4.1 XACRO语法基础：从URDF到XACRO的“一键切换”
XACRO文件的后缀是 .xacro。它和URDF最大的区别，就是多了个“头”。
一个标准的XACRO文件开头长这样：
<?xml version="1.0"?>
<robot name="my_robot" xmlns:xacro="http://www.ros.org/wiki/xacro">
<!-- 你的代码写在这里 -->
</robot>注意看 xmlns:xacro 这个属性。它告诉解析器：“嘿，我这里面要用XACRO的语法了”。我个人习惯，每次新建文件第一件事就是把这行写上，不然你后面写再多宏也没用。
rosrun xacro xacro.py model.xacro > model.urdf。调试的时候特别有用，可以看看展开后的“真面目”。
4.2 使用宏简化URDF：告别“复制粘贴”
宏，是XACRO最核心的功能。它就像C语言里的函数——你定义一次，到处调用。
举个例子。一个机械臂的每个连杆，通常都有惯性矩阵、碰撞属性、视觉属性。如果每个连杆都手写一遍，代码量至少翻三倍。我在项目中遇到过，一个七轴臂的URDF写了2000多行，后来用宏重构，直接压缩到400行。
定义一个宏的语法：
<xacro:macro name="link_inertia" params="mass ix iy iz">
<inertial>
<mass value="${mass}" />
<inertia ixx="${ix}" ixy="0" ixz="0"
iyy="${iy}" iyz="0"
izz="${iz}" />
</inertial>
</xacro:macro>调用的时候：
<xacro:link_inertia mass="1.5" ix="0.01" iy="0.01" iz="0.005" />你看，一行代码就搞定了原本需要6行的惯性参数。而且，如果你要修改所有连杆的惯性计算方式，只需要改宏定义那一处，而不是满世界找。
${} 引用。这是XACRO的变量替换语法，支持数学运算。
4.3 参数化建模：让机器人“活”起来
参数化，说白了就是“用变量代替硬编码”。
比如，你的机械臂大臂长度是0.3米，小臂长度是0.25米。如果直接写死，以后想改成0.35和0.3，你得改所有相关的坐标和尺寸。但如果你用参数：
<xacro:property name="upper_arm_length" value="0.3" />
<xacro:property name="forearm_length" value="0.25" />
<link name="upper_arm">
<visual>
<geometry>
<box size="0.05 0.05 ${upper_arm_length}" />
</geometry>
<origin xyz="0 0 ${upper_arm_length/2}" />
</visual>
</link>看到没？${upper_arm_length/2} 这种写法，直接在XML里做除法。XACRO支持加减乘除、三角函数、甚至取整。我建议你养成习惯：所有可能变化的尺寸，都用property定义。这样后期改参数，就像调旋钮一样简单。
4.4 条件语句：让一个模型适配多种配置
条件语句是XACRO的“杀手锏”。它让你能根据参数，决定是否生成某段代码。
语法很简单：
<xacro:if value="$(arg use_gripper)">
<!-- 如果有夹爪，就包含夹爪的模型 -->
<xacro:include filename="gripper.xacro" />
</xacro:if>
<xacro:unless value="$(arg use_gripper)">
<!-- 如果没有夹爪，就用一个简单的末端 -->
<link name="tool0" />
</xacro:unless>这里的 $(arg use_gripper) 是从命令行传入的参数。启动时你可以这样：
roslaunch my_robot display.launch use_gripper:=true你想想看，同一个模型文件，加不加夹爪、用哪种型号的夹爪、甚至用几根手指，都可以通过参数控制。我在做项目时，经常用这个功能来区分“仿真版”和“实物版”——仿真版加一些辅助坐标系，实物版去掉，一个文件搞定。
${arm_type == '6dof'}）、甚至字符串匹配。灵活运用，能让你的模型“千人千面”。
4.5 实战：用XACRO重构一个两连杆机械臂
光说不练假把式。我们拿一个简单的两连杆臂来演示。
原始URDF版本（部分）：
<link name="link1">
<visual>
<geometry><cylinder length="0.2" radius="0.02"/></geometry>
<origin xyz="0 0 0.1"/>
</visual>
<inertial>
<mass value="1.0"/>
<inertia ixx="0.001" ixy="0" ixz="0" iyy="0.001" iyz="0" izz="0.001"/>
</inertial>
</link>XACRO重构后：
<?xml version="1.0"?>
<robot name="two_link_arm" xmlns:xacro="http://www.ros.org/wiki/xacro">
<xacro:property name="link_length" value="0.2" />
<xacro:property name="link_radius" value="0.02" />
<xacro:property name="link_mass" value="1.0" />
<xacro:macro name="simple_link" params="name">
<link name="${name}">
<visual>
<geometry><cylinder length="${link_length}" radius="${link_radius}"/></geometry>
<origin xyz="0 0 ${link_length/2}"/>
</visual>
<inertial>
<mass value="${link_mass}"/>
<inertia ixx="${0.5 * link_mass * link_radius^2}" ixy="0" ixz="0"
iyy="${0.5 * link_mass * link_radius^2}" iyz="0"
izz="${0.5 * link_mass * link_length^2}"/>
</inertial>
</link>
</xacro:macro>
<xacro:simple_link name="link1" />
<xacro:simple_link name="link2" />
</robot>你看，代码量减少了一半以上，而且可读性更强。更重要的是，如果你想改成三连杆，只需要加一行 <xacro:simple_link name="link3" /> 就行。
macros.xacro 文件里，然后用 <xacro:include filename="macros.xacro" /> 引入。这样主文件干净清爽，宏定义还能复用。
4.6 本章小结
XACRO不是一门新语言，它只是URDF的“增强包”。但用好它，你的机器人建模效率能提升一个数量级。
- 宏定义：把重复的代码块封装起来，一次定义，到处调用。
- 参数化：用property定义变量，用${}做数学运算，让模型可配置。
- 条件语句：用if/unless控制代码生成，一个模型适配多种场景。
嗯，这一章的内容就到这里。记住，写XACRO就像写程序——好的架构能让你后期省心百倍。别急着一次写完，先规划好哪些是变量、哪些是宏，再动手。