› 逆向运动学计算器 返回
分析工具

机器人手臂逆向运动学计算器(2/3自由度)

根据目标位置计算2R平面或3R空间模型的关节角。3R模式的位置计算使用L₁、L₂;L₃仅作参考显示。

参数设置
模式
杆长
L₁ 杆长1
mm
L₂ 杆长2
mm
L₃ 杆长3
mm
目标位置
目标 X
mm
目标 Y
mm
目标 Z
mm
关节限制
θ₁: ±150°, θ₂: ±170°, θ₃: ±170°
计算结果
—
θ₁ [deg]
—
θ₂ [deg]
—
末端误差 [mm]
—
det(J)
—
可达性
—
奇异点距离
逆运动学解
移动滑块即切换为手动操作
理论与主要公式

由第 2 关节角的余弦值求出两个解:

$$c_2 = \frac{x^2+y^2-L_1^2-L_2^2}{2L_1 L_2}, \quad s_2 = \pm\sqrt{1-c_2^2}$$ $$\theta_2 = \text{atan2}(s_2, c_2)$$ $$\theta_1 = \text{atan2}(y,x) - \text{atan2}(L_2 s_2,\ L_1+L_2 c_2)$$

可达条件:$|L_1-L_2| \le \sqrt{x^2+y^2} \le L_1+L_2$。3R 空间模式用带阻尼的高斯–牛顿迭代 $\Delta\theta=(J^TJ+\lambda I)^{-1}J^T(\mathbf{x}^*-\mathbf{x})$(λ=0.01,迭代 24 次)求 θ₁~θ₃,L₃ 仅作参考绘制,不计入末端位置。

什么是机器人手臂逆运动学

🙋
逆运动学是什么?听说是从“目标位置”求“关节角度”,它和正运动学有什么区别?
🎓
大致来说,正运动学计算的是“关节弯这么多,手末端会到哪里?”逆运动学正相反,求解的是“我想把手末端放到这里!各关节要弯多少度?”例如,在这个模拟器中改变“目标 X”和“目标 Y”的值,手臂的姿态会大幅变化,那正是按逆运动学算出的角度在运动。
🙋
咦,同一个目标位置,手臂有时会有两种形状!显示着“肘向上”和“肘向下”。为什么会有两个解?
🎓
观察得好。两杆手臂把末端送到同一位置,一般有肘朝上和肘朝下两种方式。数学上对应 $s_2 = \pm\sqrt{1-c_2^2}$ 中正负号的选择。实务中会选择不与周围机械碰撞、或在关节活动范围内的那一个。本工具同时用不同颜色显示两种姿态(肘向上/向下),可以比较一下。
🙋
有时会显示“奇异点”。手臂伸得笔直时,一想动它就突然乱动……那是怎么回事?
🎓
那正是“奇异点”,机器人控制中最需要注意的状态之一。手臂完全伸直或折叠时,若想让末端沿某个方向(手臂的长度方向)运动,关节速度在理论上会发散到无穷大。在模拟器中把“杆长1”和“杆长2”设成差不多的值,再把目标点沿 X 方向尽量推远(移动滑块后自动跟踪会停止)。手臂应该会变成一条直线并显示“奇异点”。现场的铁则是规划避开这种姿态的路径。

常见问题

在2R模型中,余弦定理给出的sin θ₂有正负两个分支。本工具称正分支为肘向下(蓝色),负分支为肘向上(绿色)。奇异姿态下两分支重合;关节限制可能排除其中一个或两个。本工具不进行碰撞检测。
对于2R手臂,完全伸直或折叠时雅可比行列式为零,属于奇异姿态。某些末端运动方向无法瞬时实现;在奇异点附近,指定末端速度可能需要很大的关节速度,并非所有关节速度都会变成无穷大。
目标超出最大或最小伸展范围时无解。关节限制关闭时,灰色姿态表示几何上最近的位置,并显示与目标的距离。关节限制开启且无解时,本工具不计算限制内的最近姿态,因此角度和误差显示为“—”。
本工具的 3R 空间模式用基座旋转 θ₁、肩 θ₂、肘 θ₃ 三个关节使末端对准三维目标 (x,y,z)。它不是解析解,而是用带阻尼的高斯–牛顿法(雅可比伪逆,λ=0.01,步长系数 0.5)最多迭代 24 次求 θ₁~θ₃,末端误差小于 10 mm 时显示“可达”,否则显示“未收敛”。第 3 杆 L₃ 仅作绘制,不计入末端位置的计算。
雅可比矩阵J将关节角速度映射为末端速度(dx/dt = J·dθ/dt)。本工具的2R模式使用余弦定理解析解,3R模式使用带阻尼的迭代法。冗余取决于独立关节数与任务位置或姿态维数的关系,并非关节数达到3个就一定冗余。
关节限制关闭时,2R工作空间的半径范围为|L₁−L₂|至L₁+L₂。杆长相等时内半径为零;杆长不等时原点附近存在不可达的圆形区域。调整L₁和L₂可比较图形;开启关节限制会进一步限制实际可达区域。
同一个末端位置或姿态可能对应多个关节配置。运动中切换解可能导致关节突然大幅运动。实际路径规划需要考虑关节限制、碰撞和运动连续性。本工具同时显示有效的2R分支,不进行路径规划或碰撞检测。
本工具显示输入目标的运动学解,不模拟惯性、摩擦、电机转矩或控制系统,因此不能预测真实跟踪时间。可使用滑块或数字输入框改变目标位置。

现实世界中的应用

工业机器人(焊接、搬运):汽车工厂的焊接机器人必须把焊枪精确地送到车身的指定位置。逆运动学快速算出各关节的目标角度,实现平滑的路径。避开奇异点的路径规划是安全运行所必需的。

手术辅助机器人:在内窥镜手术中,按医生的操作把钳子前端精确定位到患处。为了在患者体内的有限空间中避开障碍物(其他器官),从多个逆运动学解中选择最合适的姿态(肘向上/向下)。

动画与 CG 制作:为了让角色的手脚以自然的动作到达特定位置,大量使用逆运动学。设置关节活动范围限制,可以自动生成符合人体、不勉强的动作。

多关节结构的 CAE 分析:对机器人手臂和建筑机械进行结构分析(FEM)时,需要把实际可能出现的受载姿态设为初始状态。利用逆运动学得到的关节角度,可以切合实际地定义分析模型的初始姿态。

常见误解与注意事项

首先是“杆越长越好”的误解。杆长确实会扩大可达范围,但也更容易陷入奇异点(手臂成一条直线的姿态),使控制不稳定。例如用 L₁=L₂=300 mm 的手臂瞄准目标点 (595, 0),勉强能到达,却非常接近完全奇异点,可以模拟出微小位置指令就使关节剧烈运动的“乱动”。实务中应按工件尺寸选择必要的最小臂长,并设计留有余量的活动范围。

其次是“只要求出解就行”的想法。即使数学上算出了角度,也常常超出机器人的物理活动范围。例如 θ₂ 活动范围为 −120°~120° 的关节,若计算结果是 150°,就必须判定为“不可达”。在本工具中即使切换解,两种姿态都触及关节限制,就意味着该位置实际上不可达。

最后是“三自由度就能自由到达二维任意位置”的过度自信。本工具的 3R 是加了基座旋转的空间手臂,用三个关节对准末端的三维位置,因此无法控制手末端的姿态(工具方向)。另一方面,若在平面内使用三个关节,相对于两个位置分量多出一个关节,逆运动学就有无穷多个解(冗余性)。本工具的迭代解只显示从初值收敛得到的一个解,而在实机上这会发展成从无穷多个解中选择“关节负荷最小的解”或“动作最平滑的解”的高级优化问题。

使用指南

  1. 以 mm 为单位输入杆长 L₁、L₂、L₃(各 100~600 mm,默认 L₁=200、L₂=150、L₃=120 mm,L₃ 仅在 3R 空间模式下显示)
  2. 以距坐标原点的 mm 指定目标位置 (x,y) 或 (x,y,z)。初始状态下目标沿路径自动移动,移动滑块即切换为手动操作(按“自动跟踪目标”可恢复)
  3. 选择模式:2R 平面用 θ₁、θ₂ 的解析解;3R 空间用带阻尼的高斯–牛顿法(雅可比伪逆)迭代 24 次
  4. 存在肘向上/肘向下两个解时同时显示,并用雅可比行列式 det(J) 判断奇异点(|det(J)| 小于 5000 mm² 时显示“接近奇异点”警告)
  5. 通过末端误差 [mm]、可达性、奇异点距离 |det(J)|/(L₁L₂)=|sin θ₂| 等卡片确认可达性和姿态好坏。打开“关节限制”后,会排除 θ₁: ±150°、θ₂、θ₃: ±170° 范围之外的解

具体计算示例

在 2R 平面模式下把目标改为手动并设为默认值(L₁=200 mm、L₂=150 mm、目标 (x,y)=(200 mm, 150 mm))时,到达距离为 √(200²+150²)=250 mm,位于可达范围 |L₁−L₂|=50 mm~L₁+L₂=350 mm 之内。解析解返回肘向下解 θ₁=0.0°、θ₂=90.0°(以及肘向上解),雅可比行列式 det(J)=30000,奇异点距离 |det(J)|/(L₁L₂)=1.0,远离奇异点。目标位置为 (360 mm, 0 mm) 时超过 L₁+L₂=350 mm,判定为“不可达”,末端误差显示不足的 10 mm。另外,3R 空间模式的迭代解目前未把杆 L₃ 计入正运动学,L₃ 不影响可达计算(仅作参考显示)。

实务注意事项

  1. 本工具只处理刚性杆件的运动学。实机上杆件挠曲、减速器背隙和间隙都会成为末端误差,请通过标定修正并为计算值留出余量
  2. 本工具在 |det(J)| 小于 5000 mm²(默认杆长下 |sin θ₂| 约小于 0.17,即接近完全伸直或完全折叠的姿态)时显示“接近奇异点”警告。轨迹规划时请插入绕开该区域的途经点
  3. 3R 空间模式的迭代从 θ₂=0.3 rad、θ₃=−0.3 rad 开始,24 次后终止,末端误差达到 10 mm 以上时显示“未收敛”。目标过远、过近或处于奇异姿态时不会收敛,请改变目标位置后重试