📚 课程目录第3章 URDF与机器人建模

3、URDF与机器人建模：URDF/Xacro语法、连杆与关节定义、惯性参数、可视化检查与常见建模错误

在ROS2与MoveIt2的机器人控制体系中，URDF（Unified Robot Description Format）是描述机器人运动学与动力学属性的核心模型文件。它不仅是RViz中可视化机器人的数据来源，更是MoveIt2进行运动规划、碰撞检测、逆运动学求解以及轨迹执行的底层基础。如果URDF建模不准确，后续所有的控制算法都将建立在错误的物理假设之上。本章将系统讲解URDF与Xacro的核心语法、连杆与关节的定义规范、惯性参数的物理意义与测量方法，以及如何通过可视化工具进行模型校验，并剖析初学者最常见的建模错误。

3.1 URDF与Xacro核心语法：从XML到可维护的工程模型

URDF本质上是一种基于XML的领域特定语言，它通过<link>和<joint>两个核心标签描述机器人的树状结构。每个<link>代表一个刚体，包含视觉（visual）、碰撞（collision）和惯性（inertial）三个子元素；每个<joint>则定义了两个连杆之间的相对变换关系与运动约束。然而，当机器人包含6个以上关节时，手写URDF会变得冗长且极易出错。Xacro（XML Macros）应运而生，它允许我们定义常量、数学表达式和可复用的宏，将重复的几何参数和结构模式抽象化。

特性	URDF原生	Xacro增强
参数复用	不支持，需重复书写	支持`<xacro:property>`定义全局常量
数学运算	不支持	支持`${}`内嵌算术表达式
模块化	单一文件	支持`<xacro:include>`拆分文件
宏定义	无	`<xacro:macro>`实现参数化连杆/关节生成

在实际工程中，我们通常使用Xacro编写主文件，通过ros2 run xacro xacro robot.urdf.xacro命令将其解析为纯URDF文件。一个典型的Xacro宏定义如下：

<xacro:macro name="box_link" params="prefix length width height mass">
  <link name="${prefix}_link">
    <visual>
      <geometry><box size="${length} ${width} ${height}"/></geometry>
    </visual>
    <collision>
      <geometry><box size="${length} ${width} ${height}"/></geometry>
    </collision>
    <inertial>
      <mass value="${mass}"/>
      <inertia ixx="1.0" ixy="0.0" ixz="0.0" iyy="1.0" iyz="0.0" izz="1.0"/>
    </inertial>
  </link>
</xacro:macro>

这种抽象方式使得我们只需修改宏参数即可生成不同尺寸的连杆，极大提升了建模效率。但需要注意，Xacro的数学表达式在解析时使用Python的eval函数，因此必须确保表达式中的变量已定义且类型正确。

3.2 连杆与关节定义：坐标系、轴与运动学约束

关节（joint）的定义是URDF中最容易出错的部分。每个关节必须明确指定类型（revolute、prismatic、fixed、floating、planar）、父连杆（parent）与子连杆（child）、以及关节原点（origin）相对于父连杆坐标系的变换。其中，origin的xyz和rpy属性定义了子连杆坐标系在父连杆坐标系中的位置与姿态，而axis属性则指定了旋转或平移的运动轴（在关节坐标系中表示）。

核心原则：关节的origin是子连杆坐标系相对于父连杆坐标系的静态变换，而axis是运动方向。对于revolute关节，正方向旋转遵循右手定则。MoveIt2在运动规划时，会依据这些参数构建机器人的运动学树，任何坐标系的微小偏差都会导致末端执行器位姿计算错误。

以常见的六轴机械臂为例，其肩部、肘部和腕部关节通常为revolute类型。定义肩部关节时，需要确保origin的rpy值正确反映了关节轴的方向。例如，如果关节绕Z轴旋转，则rpy应为"0 0 0"；如果绕Y轴旋转，则rpy应为"0 1.5708 0"（即90度）。初学者常犯的错误是将旋转轴与坐标系轴混淆，导致关节运动方向与预期不符。

3.3 惯性参数：动力学仿真与控制的物理基础

惯性参数（inertial）包括质量（mass）和惯性张量（inertia）。惯性张量是一个3x3对称矩阵，描述了刚体绕其质心旋转时的质量分布。在URDF中，我们只需指定ixx、iyy、izz（主惯性矩）以及ixy、ixz、iyz（惯性积）。对于规则几何体（如立方体、圆柱体），可以通过标准公式计算惯性张量；对于复杂形状，则需要借助CAD软件或实验测量。

惯性参数直接影响MoveIt2中的动力学计算、轨迹优化以及仿真环境（如Gazebo）中的物理响应。如果惯性参数缺失或设置错误，MoveIt2在计算逆动力学或执行力矩控制时会输出错误结果，甚至导致规划失败。一个常见的错误是使用默认的惯性张量（如全1），这会使机器人模型在仿真中表现出不真实的“轻飘”或“沉重”感。

风险提示：在MoveIt2中，如果某个link的inertial标签缺失，MoveIt2会将其视为质量为零的刚体，这可能导致运动规划器在优化轨迹时出现奇异解。建议在建模初期就为每个link提供合理的惯性参数，即使是通过估算获得。

对于圆柱体连杆，其惯性张量计算公式为：ixx = iyy = 0.5 * m * r^2，izz = 0.5 * m * r^2 + (1/12) * m * l^2（其中r为半径，l为长度）。在Xacro中，我们可以利用数学表达式自动计算这些值，避免手动输入错误。

3.4 可视化检查与常见建模错误排查

完成URDF建模后，必须进行可视化验证。ROS2提供了多种工具：check_urdf命令用于检查URDF语法和结构完整性；urdf_to_graphiz生成树状结构图；RViz配合robot_state_publisher节点可以实时显示机器人模型并发布关节状态。在RViz中，我们可以通过拖动关节滑块来验证关节运动方向是否正确，以及是否存在连杆之间的碰撞穿透。

错误类型	典型现象	排查方法
坐标系翻转	关节旋转方向相反或连杆位置错位	检查joint的origin.rpy和axis定义
惯性单位错误	仿真中机器人抖动或漂移	确认质量单位为kg，惯性张量单位为kg·m²
碰撞模型缺失	MoveIt2规划时忽略障碍物	确保每个link都有collision标签
关节极限未定义	规划器生成超出物理范围的轨迹	为revolute/prismatic关节设置limit标签

一个典型的排障案例：某工程师在建模六轴机械臂时，发现第三关节在RViz中旋转方向与实机相反。通过检查URDF，发现该关节的axis被错误地设置为"0 0 1"（Z轴），而实际机械臂的第三关节是绕Y轴旋转。修正为"0 1 0"后，运动方向恢复正常。这个案例说明，在建模前必须仔细核对机械臂的DH参数表或CAD模型中的关节轴方向。

经验总结：建议在建模完成后，使用ros2 run tf2_tools view_frames生成TF树，检查所有坐标系之间的变换是否符合预期。同时，在MoveIt2的Setup Assistant中加载URDF时，注意观察自动生成的碰撞矩阵和规划组是否合理。

最后，需要强调的是，URDF建模是一个迭代过程。在Gazebo或MoveIt2中进行仿真测试时，如果发现机器人运动异常，应首先回到URDF文件检查几何、惯性和关节定义。一个经过充分验证的URDF模型，是后续所有高级控制功能（如避障规划、力控、抓取）稳定运行的基石。通过本章的学习，读者应能够独立完成一个机械臂的URDF建模，并通过可视化工具进行系统性校验。