4、URDF与Xacro建模：机械臂URDF编写、关节与连杆定义、可视化与碰撞检测
在ROS2与MoveIt2的机器人开发体系中，URDF（Unified Robot Description Format）是描述机器人运动学与动力学属性的核心模型文件。它不仅是RViz中可视化机械臂的基础，更是MoveIt2进行运动规划、碰撞检测、逆解计算与轨迹执行的“物理事实来源”。本章将围绕机械臂URDF的编写规范、关节与连杆的定义方法、Xacro宏语言的高效建模技巧，以及可视化与碰撞检测的工程实践展开深入讲解。我们将从核心原理出发，结合具体代码案例与常见误区，帮助您建立一套完整、可复用且符合MoveIt2规范的机械臂建模能力。
上图展示了从URDF/Xacro源文件到MoveIt2功能集成的完整链路。左侧是标准URDF文件，右侧是Xacro宏定义，两者经过预处理后生成统一的机器人模型。模型的核心由连杆（link）和关节（joint）构成，并形成严格的运动学树。向下延伸，该模型分别驱动RViz可视化、MoveIt2运动规划以及碰撞检测模块，最终通过MoveIt2 Setup Assistant生成完整的机器人配置包。理解这条链路，是掌握机械臂建模的关键。
4.1 核心原理：URDF的XML结构与运动学树
URDF本质上是一个基于XML格式的文本文件，它通过<link>和<joint>两个核心标签来描述机器人的物理结构。每个<link>代表一个刚体（如基座、连杆、末端执行器），而每个<joint>则定义了两个连杆之间的连接关系与运动约束。所有关节和连杆必须构成一棵无环的树状结构，即每个连杆只能有一个父关节，但可以有多个子关节。这棵树被称为“运动学树”，它是TF树、MoveIt2规划组和碰撞检测的基础。
一个标准的URDF文件包含以下关键部分：
- 连杆属性（link）：包含
visual（可视化几何体）、collision（碰撞检测几何体）和inertial（惯性参数，用于动力学计算）。 - 关节属性（joint）：定义关节类型（revolute、prismatic、fixed等）、父连杆与子连杆、原点坐标（xyz与rpy）以及运动学约束（如关节限位）。
- 材质与颜色（material）：用于在RViz中渲染连杆外观，可复用。
在MoveIt2中，URDF被加载到robot_model_loader节点中，并构建成RobotModel对象。该对象不仅包含运动学树，还通过PlanningScene管理碰撞检测。因此，URDF中collision标签的准确性直接决定了MoveIt2避障与自碰撞检测的可靠性。
4.2 操作流程：从零编写六轴机械臂URDF
下面我们以一个典型的六轴串联机械臂为例，演示URDF的编写流程。假设机械臂由基座（base_link）、肩部（shoulder_link）、大臂（upper_arm_link）、小臂（forearm_link）、腕部（wrist_link）和末端（flange_link）组成。
- 定义基座连杆：基座通常使用
fixed关节连接到世界坐标系（world），并定义其几何形状与惯性。 - 添加旋转关节：每个旋转关节（revolute）需要指定旋转轴（xyz）、原点位置（相对父连杆）以及限位（
limit）。 - 配置连杆几何：为每个连杆添加
visual标签，使用mesh或cylinder/box/sphere等基本几何体。推荐使用STL或DAE网格文件以获得真实外观。 - 添加碰撞体：碰撞体应尽量简化，使用凸包或基本几何体包裹连杆，避免使用高精度网格导致碰撞检测计算量过大。
- 验证模型：使用
check_urdf工具检查文件合法性，并在RViz中加载查看。
以下是一个简化的URDF片段，展示了一个旋转关节与连杆的定义：
<link name="upper_arm_link">
<visual>
<geometry>
<mesh filename="package://my_robot/meshes/upper_arm.stl"/>
</geometry>
<origin xyz="0 0 0.15" rpy="0 0 0"/>
</visual>
<collision>
<geometry>
<box size="0.1 0.1 0.3"/>
</geometry>
</collision>
</link>
<joint name="shoulder_pan_joint" type="revolute">
<parent link="base_link"/>
<child link="upper_arm_link"/>
<origin xyz="0 0 0.2" rpy="0 0 0"/>
<axis xyz="0 0 1"/>
<limit lower="-3.14" upper="3.14" effort="100" velocity="1.5"/>
</joint>在实际工程中，手动编写所有连杆的坐标与惯性参数极易出错。因此，我们强烈推荐使用Xacro宏来参数化建模，减少重复代码并提高可维护性。
4.3 案例拆解：使用Xacro宏定义模块化机械臂
Xacro（XML Macros）允许我们定义可复用的宏，支持数学运算、属性继承和条件判断。对于多轴机械臂，我们可以定义一个“关节-连杆”宏，然后通过传入不同参数实例化多个关节。
以下是一个Xacro宏的示例，用于生成一个带有减速比和限位的旋转关节模块：
<xacro:macro name="revolute_joint" params="name parent child origin_xyz origin_rpy axis_xyz limit_lower limit_upper">
<joint name="${name}" type="revolute">
<parent link="${parent}"/>
<child link="${child}"/>
<origin xyz="${origin_xyz}" rpy="${origin_rpy}"/>
<axis xyz="${axis_xyz}"/>
<limit lower="${limit_lower}" upper="${limit_upper}" effort="100" velocity="2.0"/>
</joint>
</xacro:macro>
<!-- 使用宏 -->
<xacro:revolute_joint name="joint2" parent="base_link" child="link2"
origin_xyz="0 0 0.3" origin_rpy="0 0 0" axis_xyz="0 1 0"
limit_lower="-2.5" limit_upper="2.5"/>通过Xacro，我们还可以定义全局属性（如材料颜色、电机重量）和数学表达式（如根据连杆长度自动计算重心位置）。在MoveIt2中，setup_assistant会自动解析Xacro文件，但需要确保在运行前已安装xacro包，并正确配置了robot_description参数。
下面是一个典型的Xacro文件头与属性定义：
<robot name="my_arm" xmlns:xacro="http://www.ros.org/wiki/xacro">
<xacro:property name="pi" value="3.141592653589793"/>
<xacro:property name="link_length" value="0.25"/>
<xacro:property name="link_radius" value="0.05"/>
<material name="blue">
<color rgba="0.1 0.2 0.8 1.0"/>
</material>
<!-- 后续宏调用 -->
</robot>4.4 可视化与碰撞检测：RViz与MoveIt2的协同
完成URDF编写后，我们需要在RViz中验证模型是否正确。启动robot_state_publisher节点，它会读取robot_description参数并发布TF树。同时，需要发布/joint_states话题来驱动关节运动。在RViz中，我们可以添加RobotModel显示组件，并选择固定坐标系（如base_link）。
碰撞检测是MoveIt2规划的核心安全机制。MoveIt2使用FCL（Flexible Collision Library）库进行碰撞检测，其检测对象来自URDF中的collision标签。在MoveIt2 Setup Assistant中，我们可以生成“允许碰撞矩阵”（ACM），用于标记哪些连杆对在规划时可以忽略碰撞（例如相邻连杆之间），从而加速规划计算。但必须注意，ACM的生成需要谨慎，错误的忽略可能导致规划路径与机械臂实际结构发生干涉。
下表对比了visual与collision标签的工程差异：
| 对比维度 | visual（可视化） | collision（碰撞） |
|---|---|---|
| 几何精度 | 高精度网格（STL/DAE） | 简化几何体（box/cylinder/sphere） |
| 计算开销 | 仅渲染，开销低 | 参与碰撞检测，开销高 |
| 工程建议 | 使用真实外观模型 | 使用凸包或包裹体，避免凹面 |
| 错误影响 | 显示异常，不影响规划 | 导致规划失败或碰撞事故 |
在调试碰撞检测时，可以通过RViz的PlanningScene插件查看当前碰撞状态，红色高亮表示发生碰撞。此外，MoveIt2提供了collision_detection命令行工具，可以快速测试两个连杆之间是否存在碰撞。
4.5 常见误区与总结复盘
在URDF建模过程中，初学者常犯以下错误：
- 忽略惯性参数：如果
inertial标签缺失或数值不合理，MoveIt2的动力学求解器（如KDL）会报错或产生错误轨迹。建议为每个连杆设置合理的质量与惯性张量。 - 碰撞体过于精细：直接使用STL网格作为碰撞体，会导致碰撞检测计算量剧增，实时性下降。应使用简化几何体。
- 关节轴方向错误：旋转轴（axis）必须相对于父连杆坐标系定义，方向错误会导致运动学解算异常。
- 树结构断裂：如果某个连杆没有正确连接到父关节，MoveIt2会报“Robot model is not a tree”错误。
为了帮助您快速定位问题，我们总结了一个排障清单：
- 使用
check_urdf my_robot.urdf检查语法。 - 在RViz中查看TF树是否连续，无跳变。
- 使用
ros2 run tf2_tools view_frames生成TF树PDF。 - 在MoveIt2中加载模型后，使用
PlanningScene的“Collision Objects”手动添加障碍物测试。
最后，请记住：URDF是机器人的“数字孪生”，它的质量直接决定了上层算法（如运动规划、避障、力控）的性能上限。在编写时，务必保持运动学树清晰、碰撞体精简、惯性参数准确。通过Xacro的模块化设计，您可以快速迭代不同构型的机械臂，为后续的MoveIt2高级功能（如抓取、运动学约束）打下坚实基础。