4、机械手臂运动学基础：直角坐标与极坐标机器人、运动轴定义、正逆运动学求解、运动空间分析

各位同学，今天我们聊点硬核的——机械手臂运动学。说实话，在光刻机这个圈子里混久了，你会发现晶圆传输系统里最核心的部件就是机械手臂。它要是罢工了，整台光刻机就得趴窝。我当年刚入行时，就亲眼见过因为手臂运动学参数没调好，导致晶圆在传输过程中直接飞出去的情况……嗯，那场面，至今难忘。

4.1 直角坐标与极坐标机器人

先说说两种最常见的机器人构型。你想想看，晶圆在光刻机内部跑来跑去，手臂得用最简洁的方式完成取放片动作。

直角坐标机器人，说白了就是三个直线轴（X、Y、Z）互相垂直。它的运动很直观——前后、左右、上下。我在项目中遇到过，这种构型最大的优点是控制简单，精度容易保证。但缺点也很明显：占用空间大，而且运动速度受限。光刻机内部寸土寸金，直角坐标机器人往往只用在一些边缘工位。

极坐标机器人就不一样了。它通常包含一个旋转轴（θ）和一个直线伸缩轴（R），再加上一个垂直升降轴（Z）。这种构型在半导体设备里非常常见，尤其是光刻机的晶圆传输系统。为什么？因为它能在很小的空间内覆盖很大的工作区域。我记得有一次调试一台老款光刻机，它的极坐标手臂在旋转时，末端执行器的线速度变化特别大——靠近旋转中心时慢，远离时快。这个特性在做运动规划时必须考虑进去。

4.2 运动轴定义

不管哪种机器人，运动轴的定义都是基础中的基础。我习惯把轴分成两类：

• 关节轴：直接驱动关节运动的轴，比如电机带动的旋转轴
• 笛卡尔轴：在直角坐标系下定义的轴，比如X、Y、Z

在光刻机晶圆传输系统中，我们通常这样定义：

轴名称	类型	运动范围	典型精度要求
R轴（伸缩）	直线轴	0~500mm	±0.1mm
θ轴（旋转）	旋转轴	0~360°	±0.01°
Z轴（升降）	直线轴	0~100mm	±0.05mm

这里要注意，轴的定义不是随便定的。我曾经见过一个项目，工程师把R轴的正方向定义反了，结果晶圆每次取片都撞到边缘传感器上……后来花了整整两天才排查出来。所以，轴定义一定要和机械设计图纸、电气接线图保持一致。

4.3 正逆运动学求解

正运动学，就是已知关节角度，求末端执行器的位置和姿态。逆运动学则反过来——已知末端位置，求关节角度。

对于极坐标机器人，正运动学其实很简单：

// 正运动学：关节空间 -> 笛卡尔空间
x = R * cos(θ)
y = R * sin(θ)
z = Z

逆运动学稍微麻烦一点：

// 逆运动学：笛卡尔空间 -> 关节空间
R = sqrt(x² + y²)
θ = atan2(y, x)
Z = z

看起来是不是很简单？但实际工程中坑很多。比如atan2函数返回的角度范围是-π到π，而你的θ轴可能支持多圈旋转。如果不做角度归一化处理，手臂可能会走一个很大的圆弧，而不是最短路径。我建议在代码里加上角度缠绕处理：

// 角度归一化到 [-π, π]
float normalizeAngle(float angle) {
    while (angle > M_PI) angle -= 2 * M_PI;
    while (angle < -M_PI) angle += 2 * M_PI;
    return angle;
}

4.4 运动空间分析

运动空间，也叫工作空间，就是机器人末端能到达的所有点的集合。对于光刻机晶圆传输系统来说，运动空间分析直接决定了晶圆能不能被安全地取放。

极坐标机器人的运动空间是一个环形区域：

• 内径由R轴的最小行程决定
• 外径由R轴的最大行程决定
• 角度范围由θ轴的限位决定

我习惯用蒙特卡洛法来可视化运动空间。说白了，就是随机生成大量关节角度组合，计算对应的末端位置，然后画成散点图。这样能直观地看到哪些区域是可达的，哪些区域是盲区。

另外，运动空间分析还要考虑晶圆夹爪的尺寸。末端执行器本身也有一定的几何尺寸，它会让实际的可达空间比理论计算的要小一圈。这个偏移量在做精密对位时尤其重要。

4.5 本章小结

机械手臂运动学，说白了就是解决“手臂怎么动”的问题。直角坐标和极坐标各有优劣，选型时要根据实际工况来定。运动轴定义要规范，正逆运动学求解要严谨，运动空间分析要全面。这些基础打好了，后面的轨迹规划和运动控制才能顺利推进。

嗯，今天就先聊到这里。记住，运动学是机械手臂控制的基石，这块搞不明白，后面全是空中楼阁。

---

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