4. 根源分析：关节(link/joint)定义中的原点(origin)参数错误

好，咱们直接切入正题。URDF 导出后模型歪了，十有八九是 origin 参数在作怪。我这些年排查过的歪斜模型，至少七成都是这个原因。你想想看，机器人每个关节和连杆的位置、朝向，全靠 origin 里的 xyz 和 rpy 来定。这俩参数一错，模型不歪才怪。

4.1 origin 参数到底管什么？

简单说，origin 定义了关节或连杆相对于其父级坐标系的偏移和旋转。它有两个核心字段：

• xyz：沿 X、Y、Z 轴的平移量，单位是米。
• rpy：绕 X（roll）、Y（pitch）、Z（yaw）轴的旋转角度，单位是弧度。

我个人习惯把 origin 想象成「安装座」。比如你给机器人装一个摄像头，xyz 就是摄像头在支架上的安装位置，rpy 就是它朝哪个方向看。这俩写错了，摄像头拍出来的画面肯定是歪的。

4.2 最常见的三种错误模式

我在项目中遇到过各种奇葩的歪斜，但归纳起来，无非下面三种情况：

错误类型	典型表现	原因
xyz 偏移错误	零件之间错位、悬空、穿模	平移量算错了，或者单位搞混（毫米 vs 米）
rpy 旋转错误	零件朝向不对，比如轮子横着转	角度符号反了，或者绕轴顺序搞错
父子关系混乱	整个子树都歪了，越传越离谱	把子级的 origin 写成了坐标

嗯，这里要注意第三种情况。很多人以为 origin 是相对于世界坐标系的，结果子关节一偏移，整个机械臂都飞到天上去。我曾经帮一个团队排查过这个问题，他们花了三天没找到原因，我一看代码，五分钟就定位了——就是父子关系理解错了。

4.3 代码示例：正确 vs 错误

咱们直接看代码。假设有一个两连杆的简单机械臂：

<!-- 正确的写法 -->
<joint name="joint_1" type="revolute">
  <parent link="base_link"/>
  <child link="link_1"/>
  <origin xyz="0 0 0.5" rpy="0 0 0"/>  <!-- 在 base_link 上方 0.5 米 -->
  <axis xyz="0 0 1"/>
</joint>

<joint name="joint_2" type="revolute">
  <parent link="link_1"/>
  <child link="link_2"/>
  <origin xyz="0 0 0.3" rpy="0 0 0"/>  <!-- 在 link_1 上方 0.3 米 -->
  <axis xyz="0 1 0"/>
</joint>

这个写法是对的。每个关节的 origin 都相对于自己的父级。但很多人会写成这样：

<!-- 错误的写法 -->
<joint name="joint_2" type="revolute">
  <parent link="link_1"/>
  <child link="link_2"/>
  <origin xyz="0 0 0.8" rpy="0 0 0"/>  <!-- 错误！把坐标写进来了 -->
  <axis xyz="0 1 0"/>
</joint>

为什么错？因为 link_2 的 origin 应该是相对于 link_1 的 0.3 米，而不是相对于 base_link 的 0.8 米。你想想看，如果 link_1 本身有旋转，那 link_2 的位置就会完全跑偏。

4.4 rpy 的绕轴顺序陷阱

说到 rpy，这里有个大坑。URDF 里 rpy 的绕轴顺序是固定的：先绕 X 轴（roll），再绕 Y 轴（pitch），最后绕 Z 轴（yaw）。这个顺序不能乱。

但很多 CAD 软件导出时，用的可能是不同的顺序（比如 ZYX 或 XYZ）。这就导致导出的 rpy 值看起来对，但实际效果完全不对。我遇到过最离谱的一次，一个摄像头导出来之后，画面是倒着的。查了半天，发现是 rpy 的绕轴顺序搞反了。

怎么检查？很简单。在 RViz 里手动旋转一下关节，看看实际旋转轴对不对。如果绕 X 轴旋转时，零件却在 Y 轴方向动，那肯定是顺序错了。

4.5 知识结构图：origin 参数错误排查流程

下面这张图总结了我平时排查 origin 问题的完整流程。你可以把它当成一个检查清单：

4.6 实战排查清单

最后，我整理了一份排查清单。每次遇到模型歪斜，我都会按这个顺序检查：

1. 确认父子关系：打开 URDF 文件，检查每个 <joint> 的 parent 和 child 是否和设计一致。
2. 检查 xyz 单位：URDF 默认单位是米。如果 CAD 导出时用了毫米，所有数值要除以 1000。
3. 验证 rpy 符号：用右手定则确认旋转方向。正号是逆时针，负号是顺时针。
4. 测试零位：把所有 rpy 设为 0，看看模型是否至少位置正确。
5. 逐级排查：从 base_link 开始，一级一级往下看。哪一级开始歪，问题就在哪一级。