三轴运动学模型：从笛卡尔到并联与串联
做运动控制这些年，我接触过不少三轴机构。说实话，最让我头疼的往往不是算法本身，而是选错了运动学模型。你想想看，一个SCARA机器人和一个Delta并联机构，虽然都是三轴，但它们的运动学方程完全是两码事。
这一章，我就带你看看三种最常用的三轴运动学模型。嗯，咱们从最简单的开始。
笛卡尔坐标系下的运动学
笛卡尔坐标系，说白了就是X、Y、Z三个轴互相垂直。这种结构最直观，也最容易理解。
核心公式：位置正解就是三个轴的位置直接相加
Px = X轴位置
Py = Y轴位置
Pz = Z轴位置我在做一台点胶机时用过这种结构。当时客户要求精度0.01mm，我直接选了滚珠丝杠加伺服电机。为什么？因为笛卡尔结构的运动学逆解太简单了——每个轴独立控制就行。
优点：
- 控制逻辑简单，每个轴互不干扰
- 刚性好，适合重载
- 精度容易保证
缺点：
- 占用空间大
- 运动惯量大，不适合高速
- 工作空间利用率低
我的经验：如果你做的是大行程、高精度的设备，比如龙门式加工中心，笛卡尔结构是首选。但要是追求速度，比如分拣机器人，那就要考虑别的方案了。
Delta并联机构运动学
Delta机器人，我最早是在食品包装线上见到的。那速度，真是快得让人眼花缭乱。它的运动学比笛卡尔复杂得多。
结构特点：三组平行四边形连杆，通过三个电机驱动。动平台始终保持水平。
位置逆解（已知末端位置，求电机角度）：
// 以其中一条臂为例
L = sqrt((Px - Ax)^2 + (Py - Ay)^2 + (Pz - Az)^2)
θ = atan2(Pz - Az, sqrt((Px - Ax)^2 + (Py - Ay)^2))
± acos((L^2 + a^2 - b^2) / (2 * L * a))我曾经调试过一台Delta机器人，一开始总是抖动。后来发现是逆解算出来的角度跳变了。为什么会这样？因为并联机构存在奇异点。嗯，这里要注意，奇异点附近的速度会突变，必须做轨迹规划避开。
避坑指南：我曾经在奇异点附近做直线插补，结果电机直接飞车了。后来我加了一个奇异点检测函数，一旦接近就自动减速。记住，并联机构的奇异点分析比串联机构重要得多。
Delta的运动学特点：
- 正解复杂，通常用数值法迭代求解
- 逆解有解析解，但要注意多解选择
- 工作空间是曲面围成的区域
SCARA机器人运动学
SCARA机器人，我习惯叫它「选择性装配机器人」。它在水平方向柔顺，垂直方向刚性。这种特性特别适合插装作业。
运动学模型：两个旋转关节加一个垂直移动关节。
正解公式：
Px = L1*cos(θ1) + L2*cos(θ1+θ2)
Py = L1*sin(θ1) + L2*sin(θ1+θ2)
Pz = d3我做SCARA的时候，最常遇到的问题就是末端抖动。你想想看，两个大臂串联，末端刚度肯定不如并联机构。后来我加了一个前馈补偿，效果好了很多。
逆解要点：
- 先解θ2：cos(θ2) = (Px^2+Py^2-L1^2-L2^2)/(2*L1*L2)
- 再解θ1：θ1 = atan2(Py,Px) - atan2(L2*sin(θ2), L1+L2*cos(θ2))
- 最后d3 = Pz
我的建议：SCARA的逆解有两个解（左臂和右臂），一定要根据实际工况选择。我一般选关节角度变化最小的那个解，这样运动更平滑。
三种模型的对比
| 特性 | 笛卡尔 | Delta并联 | SCARA串联 |
|---|---|---|---|
| 运动学复杂度 | 低 | 高 | 中 |
| 速度 | 慢 | 快 | 中 |
| 精度 | 高 | 中 | 中 |
| 工作空间 | 矩形 | 曲面 | 环形 |
| 典型应用 | 加工中心 | 分拣包装 | 电子装配 |
知识体系总览
下面这张图，是我梳理的三种运动学模型的核心逻辑。你看一眼就能明白它们之间的关系。
说实话，这三种模型没有绝对的好坏。我在实际项目中，经常要根据客户需求反复权衡。比如做高速分拣，我肯定选Delta；做精密装配，SCARA更合适；要是做大型加工，那还是老老实实用笛卡尔。
最后说一句：运动学模型是路径规划的基础。你模型建得准，后面的轨迹优化才能做得好。我见过太多人一上来就搞复杂算法，结果连正逆解都没搞对，白费功夫。
公众号:蓝海资料掘金营，微信deep3321