4. URDF与Xacro：机械臂建模、link/joint定义、可视化、加载到RViz
在ROS2与MoveIt2的机械臂控制体系中，URDF（Unified Robot Description Format）是描述机器人运动学与动力学属性的核心模型文件，而Xacro（XML Macros）则是提升URDF编写效率与可维护性的宏语言。本章将围绕机械臂建模的完整链路展开：从link（连杆）与joint（关节）的物理定义、坐标变换（TF）的生成机制，到使用Xacro进行参数化建模，最终将模型加载至RViz进行可视化验证。理解这一章节是后续进行运动学求解、碰撞检测、轨迹规划与仿真控制的前提。
4.1 核心原理：URDF的link与joint定义
URDF模型采用XML语法描述机械臂的树状结构。每个刚体部件称为link，连接两个link的约束称为joint。link通过<visual>（可视化外观）、<collision>（碰撞检测边界）和<inertial>（惯性参数）三个子标签定义物理属性。joint则通过type属性区分运动类型，并通过<parent>与<child>指定层级关系，<origin>定义子坐标系相对父坐标系的偏移（xyz）与旋转（rpy）。
在机械臂建模中，坐标系方向至关重要。ROS2遵循REP-103规范：x轴向前、y轴向左、z轴向上。对于旋转关节，通常将z轴设置为旋转轴线方向。例如，一个六轴关节型机械臂的base_link到link1的joint，其origin的rpy通常为0 0 0（若底座垂直安装），而link1的z轴指向关节旋转轴。若建模时坐标系方向错误，会导致后续MoveIt2规划出的轨迹在物理上不可达。
limit标签（包含lower、upper、effort、velocity）来构建关节空间约束。若未定义limit，该关节将被视为无限旋转，导致规划器无法生成有效轨迹。
4.2 操作流程：从Xacro宏到RViz可视化
直接编写URDF文件在机械臂关节数较多时会产生大量重复代码。Xacro通过宏定义、属性继承和数学表达式，将参数化设计引入建模流程。标准操作流程如下：
- 定义宏：使用
<xacro:macro name="link_3d" params="prefix xyz rpy">封装link与joint的通用结构。 - 参数化尺寸：将连杆长度、质量、惯性张量等定义为
<xacro:property name="link1_length" value="0.3"/>，便于统一修改。 - 数学运算：在属性值中支持
${}表达式，例如${link1_length/2}用于计算质心位置。 - 生成URDF：运行
xacro model.xacro > model.urdf展开宏。 - 启动可视化：编写launch文件，加载URDF到
robot_state_publisher，并启动joint_state_publisher_gui（用于手动拖动关节）与rviz2。
在RViz中，需要将Fixed Frame设置为base_link，并添加RobotModel显示组件。若TF树正确发布，机械臂模型将随关节滑块实时运动。若模型显示为红色或缺失，通常表示URDF中<visual>标签的mesh路径错误，或TF树存在断链。
| 步骤 | 命令/操作 | 验证方法 |
|---|---|---|
| 1. 检查URDF语法 | check_urdf model.urdf | 输出link/joint数量及树结构 |
| 2. 查看TF树 | ros2 run tf2_tools view_frames | 生成frames.pdf，确认无悬空link |
| 3. 启动模型状态发布 | ros2 launch urdf_tutorial display.launch.py model:=model.urdf | RViz中显示模型且关节可动 |
| 4. 验证碰撞属性 | 在RViz中启用Collision Enabled | 显示绿色线框包围盒 |
4.3 案例拆解：六轴机械臂的Xacro建模实战
假设需构建一个常见的六轴串联机械臂（类似UR5e构型），其关键参数为：底座高0.15m，肩部偏置0.1m，大臂长0.4m，小臂长0.35m，腕部三个关节轴线交于一点。直接编写URDF需定义6个link和6个joint，且每个link的<inertial>参数需手动计算。使用Xacro后，可定义macro name="revolute_joint"，传入关节名、父link、子link、原点坐标、旋转轴及限位。
初始现象：在RViz中加载模型后，发现link2与link3的连接处出现错位，且关节旋转方向与预期相反。分析过程：检查joint的origin定义，发现link2的末端坐标系在y方向偏移了0.05m，而实际设计图中该偏移在x方向。同时，joint2的axis定义为0 1 0（绕y轴旋转），但机械臂实际绕z轴旋转。操作步骤：修正origin的xyz为0.4 0 0，将axis改为0 0 1，并重新运行xacro生成URDF。结果对比：模型在RViz中正确对齐，关节滑块控制方向与实物一致。风险提示：若未修正惯性参数（如质量分布），MoveIt2在动力学仿真时会出现奇异加速度。
<collision>几何体简化为圆柱体或长方体，而非使用精细的STL网格。这能显著提升MoveIt2的碰撞检测速度，且不影响规划精度。例如，对于大臂，使用<cylinder radius="0.04" length="0.4"/>即可。
4.4 常见误区与总结复盘
误区一：忽略joint的limit标签。若未设置lower和upper，MoveIt2会认为关节可无限旋转，导致轨迹规划时关节空间采样失败。解决方法是参考机械臂数据手册，将限位设置为略小于物理极限（如±2.9rad）。
误区二：link坐标系方向随意。部分开发者习惯将link的z轴指向连杆方向，这会导致TF树中的旋转矩阵复杂化，且与MoveIt2的默认规划接口（期望z轴为关节旋转轴）不兼容。务必遵循“关节轴为z轴”的约定。
误区三：将Xacro文件直接加载到robot_state_publisher。该节点只接受标准URDF格式，必须先用xacro命令展开。在launch文件中，可使用Command(['xacro ', path])动态生成URDF内容。
误区四：忽视base_link的惯性属性。固定底座（fixed joint）虽然不运动，但若其<inertial>缺失或质量为零，MoveIt2的动力学求解器会报错。建议为底座设置一个较大的质量（如5kg）和合理的惯性张量。
joint_state_publisher是否发布/joint_states话题。使用命令ros2 topic echo /joint_states查看是否有数据。若话题为空，则可能是joint名称拼写错误或launch文件未正确加载参数。
总结本章，URDF与Xacro是机械臂建模的基石。通过Xacro的宏定义，可以将重复的link/joint结构抽象化，大幅减少代码量并提高参数调整效率。在可视化验证阶段，务必通过TF树和RViz的联合检查，确保每个joint的坐标系方向、限位和碰撞属性正确。只有模型在RViz中表现与实物一致，后续的MoveIt2运动规划才能获得可靠的结果。建议读者在完成本章学习后，自行搭建一个两轴或三轴的小型机械臂模型，完整走通“Xacro编写→URDF生成→RViz加载→关节控制”的流程，为后续的MoveIt2配置与规划打下坚实基础。