第三章：URDF与XACRO进阶：模块化与参数化建模

好，我们继续往下走。前两章我们把机器人模型的基础搭起来了，但说实话，那种写法只适合玩具级模型。真到了工业级项目，URDF文件动辄上千行，维护起来简直要命。我当年第一次接手一个六轴机械臂项目时，光看URDF文件就花了三天——嗯，后来我发誓一定要找到更聪明的办法。

3.1 URDF与SDF：到底选哪个？

先聊个老生常谈的问题：URDF和SDF，到底用哪个？很多新手会纠结，其实没那么玄乎。

对比维度	URDF	SDF
出身	ROS原生格式，历史久	Gazebo亲儿子，后来居上
表达能力	仅支持运动学/动力学	支持物理、传感器、场景等
复用性	差，需要XACRO救场	好，原生支持包含文件
参数化	不支持，靠XACRO	支持和
社区生态	ROS工具链完善	Gazebo仿真更友好

我的建议：如果你只做ROS机器人描述，URDF+XACRO是标配。如果你要深度使用Gazebo仿真，SDF更香。但现实是——很多项目两者混用，URDF描述本体，SDF描述仿真环境。我个人习惯用URDF做模型，用SDF做场景。

3.2 XACRO：URDF的救星

URDF最大的痛点是什么？重复。你想想看，一个六轴机械臂，六个关节的写法几乎一模一样，只是参数不同。XACRO就是来解决这个问题的。

3.2.1 宏定义：把重复代码装进盒子

宏定义是XACRO的核心。说白了，就是写一个模板，然后反复调用。我当年做移动机器人底盘时，四个轮子的URDF代码写了四遍，后来用XACRO一个宏搞定。

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="my_robot">

  <!-- 定义一个轮子宏 -->
  <xacro:macro name="wheel" params="name prefix x y z">
    <link name="${prefix}_${name}_link">
      <visual>
        <geometry>
          <cylinder radius="0.1" length="0.05"/>
        </geometry>
        <origin xyz="0 0 0" rpy="0 0 0"/>
      </visual>
      <collision>
        <geometry>
          <cylinder radius="0.1" length="0.05"/>
        </geometry>
      </collision>
    </link>

    <joint name="${prefix}_${name}_joint" type="continuous">
      <parent link="base_link"/>
      <child link="${prefix}_${name}_link"/>
      <origin xyz="${x} ${y} ${z}" rpy="0 0 0"/>
      <axis xyz="0 0 1"/>
    </joint>
  </xacro:macro>

  <!-- 调用宏创建四个轮子 -->
  <xacro:wheel name="front_left" prefix="left" x="0.3" y="0.2" z="0"/>
  <xacro:wheel name="front_right" prefix="right" x="0.3" y="-0.2" z="0"/>
  <xacro:wheel name="rear_left" prefix="left" x="-0.3" y="0.2" z="0"/>
  <xacro:wheel name="rear_right" prefix="right" x="-0.3" y="-0.2" z="0"/>

</robot>

避坑指南：我曾经在宏定义里忘了加${}，结果所有轮子都叠在一起。记住：XACRO里变量引用必须用${}，不然它只当普通字符串处理。

3.2.2 参数化：让模型活起来

参数化是模块化的灵魂。你想想看，如果每个参数都硬编码，换个轮子尺寸就得改整个文件。用参数化，改一个值就行。

<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="param_robot">

  <!-- 定义全局参数 -->
  <xacro:property name="wheel_radius" value="0.1"/>
  <xacro:property name="wheel_width" value="0.05"/>
  <xacro:property name="base_length" value="0.6"/>
  <xacro:property name="base_width" value="0.4"/>
  <xacro:property name="base_height" value="0.2"/>

  <!-- 底盘 -->
  <link name="base_link">
    <visual>
      <geometry>
        <box size="${base_length} ${base_width} ${base_height}"/>
      </geometry>
    </visual>
  </link>

  <!-- 轮子宏（使用参数） -->
  <xacro:macro name="wheel" params="name x y">
    <link name="${name}_link">
      <visual>
        <geometry>
          <cylinder radius="${wheel_radius}" length="${wheel_width}"/>
        </geometry>
      </visual>
    </link>
    <joint name="${name}_joint" type="continuous">
      <parent link="base_link"/>
      <child link="${name}_link"/>
      <origin xyz="${x} ${y} ${(base_height/2) - (wheel_radius/2)}" rpy="0 0 0"/>
    </joint>
  </xacro:macro>

  <xacro:wheel name="front_left" x="0.25" y="0.2"/>
  <xacro:wheel name="front_right" x="0.25" y="-0.2"/>

</robot>

关键点：参数化不只是改数值，更重要的是让模型各部分之间的几何关系自动计算。比如轮子高度用base_height/2 - wheel_radius/2，这样改底盘厚度时轮子位置自动调整。

3.3 模块化建模：像搭积木一样造机器人

模块化的核心思想：把机器人拆成独立的功能模块，每个模块单独维护，最后组装。我做过一个项目，需要同时开发三种不同尺寸的机器人底盘，用模块化方法，共享轮子模块和传感器模块，只改底盘参数就行。

3.3.1 文件拆分与包含

把不同部件放到不同文件里，用xacro:include引入。这样每个文件职责清晰，修改时不会牵一发动全身。

<!-- main.xacro -->
<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="modular_robot">

  <xacro:include filename="$(find my_robot)/urdf/common_defs.xacro"/>
  <xacro:include filename="$(find my_robot)/urdf/chassis.xacro"/>
  <xacro:include filename="$(find my_robot)/urdf/wheels.xacro"/>
  <xacro:include filename="$(find my_robot)/urdf/sensors.xacro"/>

  <!-- 组装 -->
  <xacro:chassis/>
  <xacro:wheels/>
  <xacro:sensors/>

</robot>

注意：文件路径用$(find package_name)，不要写路径。我见过有人写/home/user/.../，换台电脑就崩了。用find命令，ROS会自动找。

3.3.2 模块间的接口约定

模块化最怕什么？接口对不上。比如轮子模块期望底盘有个叫base_link的父节点，但底盘模块里叫chassis_link，那就完蛋。所以一定要约定好命名规则和坐标系。

命名规则：所有模块使用统一前缀，比如base_、wheel_、arm_
坐标系约定：每个模块的安装点用固定名称，比如mount_point_front_left
参数接口：模块对外暴露的参数要文档化，比如轮子模块需要wheel_radius和wheel_width

3.4 实战：构建一个模块化机械臂

光说不练假把式。我们拿一个六轴机械臂来实战。每个关节作为一个独立模块，用宏定义参数化。

<!-- arm_joint.xacro -->
<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro">

  <xacro:macro name="arm_joint" params="name parent child origin_xyz origin_rpy axis_xyz">
    <joint name="${name}_joint" type="revolute">
      <parent link="${parent}"/>
      <child link="${child}"/>
      <origin xyz="${origin_xyz}" rpy="${origin_rpy}"/>
      <axis xyz="${axis_xyz}"/>
      <limit lower="-3.14" upper="3.14" effort="100" velocity="1.0"/>
    </joint>
  </xacro:macro>

  <!-- 使用 -->
  <xacro:arm_joint name="shoulder" parent="base_link" child="upper_arm"
                   origin_xyz="0 0 0.2" origin_rpy="0 0 0" axis_xyz="0 0 1"/>
  <xacro:arm_joint name="elbow" parent="upper_arm" child="forearm"
                   origin_xyz="0 0 0.5" origin_rpy="0 0 0" axis_xyz="0 1 0"/>

</robot>

我的经验：写机械臂时，关节的origin和axis最容易出错。我建议先用rviz可视化验证，看到关节转动的方向对不对。别问我怎么知道的——我调过一个关节转了180度才发现轴方向反了。

3.5 本章知识体系

下面这张图帮你理清本章的核心逻辑。从URDF的痛点出发，到XACRO的解决方案，再到模块化实战，一条线串起来。

3.6 避坑总结

最后，把我这些年踩过的坑总结一下，你遇到类似问题可以少走弯路。

宏定义参数顺序：XACRO宏的参数是按位置匹配的，不是按名字。我曾经把x和y传反了，轮子跑到了对角线位置。
数学表达式：XACRO支持加减乘除，但注意括号要成对。我习惯在复杂表达式外面加一层${}，比如${ (a + b) * c }。
文件包含路径：用$(find pkg)而不是相对路径。我见过有人用../urdf/，结果换个工作空间就找不到文件。
可视化验证：写完模型别急着仿真，先用check_urdf命令检查语法，再用rviz看模型姿态。这一步能省你半天调试时间。

一句话总结：URDF是基础，XACRO是进阶，模块化是工程实践。三者结合，你就能像搭积木一样快速构建复杂机器人模型。记住——好的模型设计，改一个参数就能适配新需求，而不是改十处代码。

好了，这一章就到这里。下一章我们会深入Gazebo仿真环境配置，到时候见。

📚 课程目录

第三章：URDF与XACRO进阶：模块化与参数化建模

3.1 URDF与SDF：到底选哪个？

3.2 XACRO：URDF的救星

3.2.1 宏定义：把重复代码装进盒子

3.2.2 参数化：让模型活起来

3.3 模块化建模：像搭积木一样造机器人

3.3.1 文件拆分与包含

3.3.2 模块间的接口约定

3.4 实战：构建一个模块化机械臂

3.5 本章知识体系

3.6 避坑总结