3. URDF与Xacro建模：机械臂连杆、关节、惯量、碰撞体、传动装置的定义，以及使用xacro宏简化模型
在ROS2与MoveIt2的机器人控制体系中，URDF（Unified Robot Description Format）是描述机器人运动学与动力学属性的核心模型文件。它不仅是RViz中可视化机械臂的数据来源，更是MoveIt2进行碰撞检测、逆运动学求解、轨迹规划与执行验证的底层基础。一个结构严谨、参数准确的URDF模型，能够显著降低后续调试成本；反之，一个粗糙的模型往往会导致规划器报错、碰撞检测失效或仿真抖动。本章将系统讲解URDF中连杆（link）、关节（joint）、惯量（inertial）、碰撞体（collision）与传动装置（transmission）的定义方法，并深入演示如何利用xacro宏机制对重复性结构进行抽象与复用，从而构建一个既精确又易于维护的机械臂模型。
上图展示了从URDF基础元素到Xacro抽象层，再到MoveIt2消费模型的完整链路。在实际工程中，我们通常不会直接编写冗长的URDF文件，而是通过Xacro宏定义来生成URDF，再交由MoveIt2的setup assistant工具配置规划组与碰撞矩阵。下面我们将逐一拆解每个环节的具体定义方法与实战要点。
3.1 连杆（link）与关节（joint）的定义
连杆是机械臂的刚性部件，在URDF中通过<link>标签描述。每个连杆至少需要包含visual（可视化外观）、collision（碰撞检测）和inertial（惯性参数）三个子元素。其中visual决定模型在RViz中的显示效果，通常使用STL或DAE网格文件；collision用于碰撞检测，推荐使用简单的几何体（如box、cylinder、sphere）代替复杂网格，以降低计算开销；inertial则包含质量（mass）和惯性张量（inertia matrix），是动力学仿真与控制的重要输入。
关节（joint）连接两个连杆，定义了它们之间的相对运动关系。常见的关节类型包括revolute（旋转关节）、prismatic（移动关节）、fixed（固定关节）和continuous（连续旋转关节）。每个关节必须指定parent（父连杆）和child（子连杆），并通过origin定义子连杆在父连杆坐标系中的位置与姿态，通过axis指定旋转或移动的轴线方向。
origin是建模中最容易出错的地方——它表示子连杆坐标系相对于父连杆坐标系的变换，而非关节本身的位置。理解这一点是正确建模的前提。
3.1.1 连杆与关节的代码实现
<!-- 连杆定义示例 -->
<link name="link1">
<visual>
<geometry>
<mesh filename="package://my_robot/meshes/link1.stl"/>
</geometry>
<origin xyz="0 0 0.05" rpy="0 0 0"/>
</visual>
<collision>
<geometry>
<cylinder radius="0.04" length="0.1"/>
</geometry>
<origin xyz="0 0 0.05" rpy="0 0 0"/>
</collision>
<inertial>
<mass value="1.2"/>
<inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.0005"/>
</inertial>
</link>
<!-- 关节定义示例 -->
<joint name="joint1" type="revolute">
<parent link="base_link"/>
<child link="link1"/>
<origin xyz="0 0 0.1" rpy="0 0 0"/>
<axis xyz="0 0 1"/>
<limit lower="-3.14" upper="3.14" effort="10" velocity="1.0"/>
</joint>在上述代码中，limit标签定义了关节的运动范围（lower/upper）、最大力矩（effort）和最大速度（velocity）。这些参数直接影响MoveIt2的轨迹规划——如果规划出的轨迹超出关节限制，MoveIt2会拒绝执行或进行插值修正。因此，必须根据实际硬件手册填写准确的关节限位，否则可能导致规划失败甚至损坏设备。
3.2 惯量（inertial）参数的计算与标定
惯性参数是动力学仿真的核心，但在实际建模中经常被忽略或随意填写。错误的惯量参数会导致仿真中的机械臂出现“飘浮”感或异常振动。惯量张量是一个3x3对称矩阵，在URDF中通过六个独立分量（ixx, ixy, ixz, iyy, iyz, izz）表示，参考坐标系位于连杆的质心（center of mass, COM）。
计算惯量的常用方法有三种：
- CAD软件导出：在SolidWorks、Fusion 360等工具中为连杆赋予材料属性后，可直接查询质心位置和惯性张量。这是最准确的方法。
- 几何体近似计算：对于规则几何体（如圆柱、长方体），可使用标准公式计算。例如，实心圆柱绕中心轴的转动惯量为
I = 0.5 * m * r²。 - 系统辨识标定：通过实际驱动机械臂并记录力矩-加速度数据，利用最小二乘法辨识惯量参数。该方法精度高但实施复杂。
| 参数 | 含义 | 单位 | 典型值（小型6轴机械臂） |
|---|---|---|---|
| mass | 连杆质量 | kg | 0.5 - 5.0 |
| ixx | 绕X轴转动惯量 | kg·m² | 0.0001 - 0.01 |
| iyy | 绕Y轴转动惯量 | kg·m² | 0.0001 - 0.01 |
| izz | 绕Z轴转动惯量 | kg·m² | 0.0001 - 0.005 |
| ixy/ixz/iyz | 惯性积（通常为0） | kg·m² | 0.0 |
origin与质心位置不重合，必须通过<inertial><origin>指定质心在连杆坐标系中的坐标。MoveIt2在计算逆动力学时会使用这些参数，错误的质心位置会导致力矩计算偏差，进而影响力控模式下的安全性。
3.3 碰撞体（collision）的简化策略
碰撞检测是MoveIt2规划中最耗时的计算之一。如果直接使用高精度的STL网格作为碰撞体，每次碰撞检测都需要进行数千次三角形求交运算，导致规划周期显著延长。因此，工程实践中普遍采用“视觉用网格，碰撞用几何体”的策略。
简化碰撞体时需遵循以下原则：
- 包裹性：碰撞体必须完全包裹连杆的实际外形，避免出现“穿模”现象。
- 保守性：碰撞体可以略大于实际外形，但绝不能小于实际外形，否则会漏检碰撞。
- 对称性：尽量使用圆柱、球体等对称几何体，便于计算最近距离。
- 数量控制：单个连杆的碰撞体数量不超过2-3个，复杂形状可用多个几何体组合。
3.4 传动装置（transmission）与ros2_control集成
传动装置在URDF中通过<transmission>标签定义，它建立了关节与执行器（电机/舵机）之间的映射关系。在ROS2中，transmission是ros2_control硬件抽象层的重要组成部分，它将URDF中的关节名称映射到实际硬件接口（如PositionJointInterface、VelocityJointInterface）。
<transmission name="trans_joint1">
<type>transmission_interface/SimpleTransmission</type>
<joint name="joint1" role="actuator">
<hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
</joint>
<actuator name="motor1">
<mechanicalReduction>100.0</mechanicalReduction>
<hardwareInterface>hardware_interface/PositionJointInterface</hardwareInterface>
</actuator>
</transmission>在上述配置中，mechanicalReduction表示减速比（电机转速/关节转速）。对于带谐波减速器的机械臂关节，减速比通常在50:1到160:1之间。正确配置减速比对于力矩控制和速度控制至关重要——如果减速比错误，控制器输出的力矩指令会与实际关节力矩相差一个数量级。
3.5 使用Xacro宏简化模型构建
当机械臂包含多个结构相似的连杆时（例如6轴机械臂的6个关节），直接编写URDF会产生大量重复代码。Xacro（XML Macros）提供了一种优雅的解决方案，它允许我们定义带参数的宏，并在多个位置复用。
3.5.1 宏定义与参数化
<?xml version="1.0"?>
<robot xmlns:xacro="http://www.ros.org/wiki/xacro" name="my_robot">
<!-- 定义连杆宏 -->
<xacro:macro name="link_spec" params="name length radius mass">
<link name="${name}">
<visual>
<geometry>
<cylinder radius="${radius}" length="${length}"/>
</geometry>
</visual>
<collision>
<geometry>
<cylinder radius="${radius * 1.05}" length="${length}"/>
</geometry>
</collision>
<inertial>
<mass value="${mass}"/>
<inertia ixx="${0.5 * mass * radius * radius}"
iyy="${0.5 * mass * radius * radius}"
izz="${0.5 * mass * radius * radius}"/>
</inertial>
</link>
</xacro:macro>
<!-- 调用宏生成连杆 -->
<xacro:link_spec name="link1" length="0.2" radius="0.04" mass="1.0"/>
<xacro:link_spec name="link2" length="0.25" radius="0.035" mass="0.8"/>
</robot>在上述宏定义中，我们使用了${}语法进行数学运算，例如${radius * 1.05}表示碰撞体半径比视觉半径大5%。这种参数化方式使得模型调整变得极其方便——只需修改一处参数，所有相关属性都会自动更新。
3.5.2 文件包含与模块化
对于大型机器人项目，建议将模型拆分为多个xacro文件：
robot.urdf.xacro：主文件，包含机器人名称和顶层结构。macros.xacro：通用宏定义库。sensors.xacro：传感器（如相机、IMU）的模型定义。gripper.xacro：末端执行器模型。
通过<xacro:include filename="macros.xacro"/>指令引入其他文件，实现模块化开发。这样多个开发者可以并行维护不同部件，且便于版本管理。
3.6 模型验证与常见错误排查
完成模型编写后，必须进行严格的验证才能用于MoveIt2。ROS2提供了两个关键工具：
- xacro预处理：
xacro robot.urdf.xacro > robot.urdf，将xacro文件展开为纯URDF文件，检查是否有语法错误或未定义的宏。 - URDF检查：
check_urdf robot.urdf，该命令会解析URDF并输出机器人结构树，同时报告缺失的必需标签或无效的数值。
- 关节origin设置错误：导致连杆在RViz中显示位置错乱。解决方法是逐级检查每个关节的
origin，确保子连杆坐标系正确。 - 惯量参数为零：某些用户为了省事将惯量全部填0，这会导致仿真崩溃或控制异常。即使不确定精确值，也应填写一个数量级合理的近似值。
- 碰撞体与视觉体偏差过大：导致规划器认为机械臂被“卡住”而无法运动。
- 关节限位设置过宽：超出硬件实际范围，在真机运行时可能触发硬件保护。
3.7 实战案例：6轴机械臂模型的xacro化重构
假设我们有一个6轴串联机械臂，原始URDF文件包含约1200行重复代码。通过xacro重构，我们将代码量压缩至300行左右，同时提高了可维护性。
初始状态与目标：原始URDF中每个连杆的visual、collision、inertial代码结构完全相同，仅数值不同。目标是通过宏定义消除重复，并支持通过修改一个参数文件快速调整整机尺寸。
关键操作步骤：
- 分析6个连杆的共性，提取参数：
length（长度）、radius（半径）、mass（质量）、joint_offset（关节偏移）。 - 定义
link_spec宏，接收上述参数并生成完整的link定义。 - 定义
joint_spec宏，接收parent、child、origin、axis等参数。 - 在
robot.urdf.xacro中依次调用宏，传入各连杆的具体数值。 - 使用
xacro命令生成URDF，并用check_urdf验证。
结果对比：重构后，模型文件从1200行缩减至350行，修改连杆长度时只需改动一处参数，所有相关属性（视觉、碰撞、惯量）自动更新。在MoveIt2中加载速度提升约30%，因为xacro展开后的URDF结构更紧凑。
风险与代价：宏的过度抽象可能导致模型可读性下降。建议在宏定义中添加详细注释，并保持宏的粒度适中——每个宏只负责一个明确的建模单元，避免“万能宏”的出现。