第二节：机械手运动学基础

各位同学好，我是老张。在半导体设备这行摸爬滚打了十几年，今天咱们来聊聊机械手运动学的基础。说实话，这部分内容看着有点抽象，但它是整个控制系统的地基。地基没打好，后面再漂亮的算法都是空中楼阁。

我刚开始接触晶圆传输机械手时，总觉得运动学就是一堆公式。后来在调试现场吃过亏才明白——坐标系没搞对，机械手能直接撞上腔室壁。嗯，咱们先从最基础的坐标系说起。

2.1 坐标系定义

坐标系这东西，说白了就是给机械手一个「定位基准」。没有坐标系，你告诉机械手「往右走10厘米」，它根本不知道「右」是哪个方向。在晶圆传输场景中，我们主要用三种坐标系：

2.1.1 世界坐标系

世界坐标系是固定不动的。它通常定义在设备基座上，是整个系统的绝对参考。我个人习惯把世界坐标系的原点放在设备底座的几何中心，Z轴垂直向上，X轴指向设备正面。

为什么要这样定义？因为晶圆传输机械手要跟多个工艺腔室对接，每个腔室的位置都是相对世界坐标系固定的。你想想看，如果坐标系定义得乱七八糟，后续的标定工作会非常痛苦。

2.1.2 工具坐标系

工具坐标系是定义在机械手末端执行器上的。对于晶圆传输机械手，末端执行器就是那个「叉子」——晶圆叉。工具坐标系的原点通常放在晶圆中心，Z轴垂直于晶圆表面。

我在项目中遇到过一个问题：某次调试时，机械手抓取晶圆总是偏一点。查了半天，发现是工具坐标系没校准好。晶圆叉本身有制造公差，理论坐标和实际坐标差了0.5毫米。对于300mm晶圆来说，0.5毫米的偏差足以导致传输失败。

2.1.3 工件坐标系

工件坐标系是定义在晶圆本身上的。虽然晶圆是圆形对称的，但为了精确定位，我们还是会定义一个工件坐标系。原点在晶圆中心，X轴指向晶圆缺口（notch）或平边（flat）。

为什么要定义工件坐标系？因为晶圆在传输过程中可能会旋转。如果机械手只知道「晶圆在位置A」，但不知道「晶圆转了30度」，那放回晶圆盒时就会出问题。

坐标系类型	原点位置	用途
世界坐标系	设备基座	绝对定位基准
工具坐标系	晶圆叉中心	末端执行器控制
工件坐标系	晶圆中心	晶圆姿态描述

2.2 关节空间与笛卡尔空间

这两个概念，我刚开始学的时候也绕了很久。简单来说：

• 关节空间：用每个关节的角度来描述机械手的位置。比如「关节1转了30度，关节2转了45度，关节3转了-10度」。
• 笛卡尔空间：用三维坐标来描述末端的位置。比如「末端在X=100mm, Y=200mm, Z=50mm处」。

你可能会问：为什么要有两种描述方式？

因为控制机械手时，我们通常用笛卡尔空间来规划路径——告诉机械手「从A点直线运动到B点」。但实际驱动电机时，必须转换成关节空间的角度值——告诉每个电机「你转多少度」。

2.3 正逆运动学概念

正逆运动学，说白了就是两个方向的转换：

• 正运动学：已知关节角度，求末端位置。这个相对简单，就是套公式计算。
• 逆运动学：已知末端位置，求关节角度。这个比较麻烦，因为可能有多个解，甚至无解。

我记得有一次调试，机械手需要伸到一个很深的腔室里取晶圆。我算好了末端位置，但逆运动学求解出来发现关节角度超出了机械限位。这就是典型的「可达但不可控」——位置理论上能到，但关节转不过去。

2.4 自由度与运动范围

晶圆传输机械手通常有4-6个自由度。为什么是4-6个？因为晶圆传输需要三个平移自由度（X, Y, Z）和至少一个旋转自由度（绕Z轴的旋转，即θ）。

常见的配置是：

• 4轴机械手：R（径向）、θ（旋转）、Z（升降）、T（末端旋转）。这是最经典的晶圆传输机械手结构。
• 6轴机械手：在4轴基础上增加了两个姿态调整自由度，用于更复杂的传输路径。

运动范围这块，我建议重点关注两个参数：

1. 最大行程：每个关节能转动的最大角度或移动的最大距离。
2. 工作空间：末端能到达的所有位置的集合。这个空间形状通常是个「甜甜圈」——中间有个空洞，因为机械手不能伸到自己的底座里。

2.5 知识体系总览

下面这张图是我自己整理的，把本节内容串起来了。你可以把它当作一个「思维导图」来看：

这张图把本节内容分成了四个模块。你看，从左到右，从基础到应用，逻辑是通的。坐标系是基准，空间是描述方式，运动学是转换方法，自由度是能力边界。搞懂这四个模块，机械手运动学的基础就算打牢了。

好了，这一节的内容就到这里。下一节咱们聊聊运动学方程的具体推导，到时候我会带一个实际案例——用4轴机械手做晶圆传输的完整计算过程。

---

公众号:蓝海资料掘金营，微信deep3321