二连杆平面机械臂的末端位置(正运动学):
$$x = L_1\cos\theta_1 + L_2\cos(\theta_1+\theta_2)$$ $$y = L_1\sin\theta_1 + L_2\sin(\theta_1+\theta_2)$$雅可比行列式(奇异点指标):
$$\det J = L_1\,L_2\,\sin\theta_2$$工作空间半径:$|L_1 - L_2| \le r \le L_1 + L_2$,奇异姿态:$\theta_2 = 0°$ 或 $180°$。
由连杆长度 L₁、L₂ 与关节角度 θ₁、θ₂ 实时计算末端位置 (x, y),可视化机械臂姿态、环状工作空间,并显示雅可比行列式 detJ = L₁L₂sinθ₂。
二连杆平面机械臂的末端位置(正运动学):
$$x = L_1\cos\theta_1 + L_2\cos(\theta_1+\theta_2)$$ $$y = L_1\sin\theta_1 + L_2\sin(\theta_1+\theta_2)$$雅可比行列式(奇异点指标):
$$\det J = L_1\,L_2\,\sin\theta_2$$工作空间半径:$|L_1 - L_2| \le r \le L_1 + L_2$,奇异姿态:$\theta_2 = 0°$ 或 $180°$。
二连杆平面机械臂以原点为基座关节,连杆 1 的长度为 $L_1$,旋转角 $\theta_1$;其末端是第二个关节,连杆 2 长度 $L_2$,相对角 $\theta_2$。末端位置 $(x, y)$ 是简单的三角函数之和。
$$x = L_1\cos\theta_1 + L_2\cos(\theta_1+\theta_2),\quad y = L_1\sin\theta_1 + L_2\sin(\theta_1+\theta_2)$$
雅可比矩阵:$J = \begin{pmatrix} -L_1\sin\theta_1 - L_2\sin(\theta_1+\theta_2) & -L_2\sin(\theta_1+\theta_2) \\ L_1\cos\theta_1 + L_2\cos(\theta_1+\theta_2) & L_2\cos(\theta_1+\theta_2)\end{pmatrix}$,$\det J = L_1 L_2 \sin\theta_2$。
到达距离:$r = \sqrt{x^2+y^2}$,工作空间:$|L_1-L_2| \le r \le L_1+L_2$,奇异姿态:$\theta_2 = 0°, \pm 180°$。
工业机械臂示教再现:焊接、装配、搬运等场景中,记录关节角度的时间序列后用正运动学在示教器或仿真器中重现末端轨迹。ROS、MoveIt、RoboDK 等仿真平台的核心计算都依赖这种 FK。
FEM 多体分析的姿态布置:多关节机械臂的刚度、模态、接触分析必须先按代表性姿态布置网格。由关节角度通过正运动学得到各连杆坐标后,再施加载荷与约束。
外科机器人与遥操作:主端操作的关节角度通过正运动学映射为从端末端位置,并实时叠加到画面上。闭式 FK 能将通信与计算时延降到最低,对手术安全极为关键。
CG、动画与 VR 绑定:角色的关节旋转通过 FK 推动末端位置,再叠加 IK 实现目标跟随,可生成自然的运动。
首先,"FK 简单所以不用关心精度"是错误的。编码器分辨率和连杆制造公差直接累加到末端误差。例如 L₁ = L₂ = 50 cm 的机械臂,关节角度有 0.1° 误差时末端约偏离 0.17 mm,臂越长误差放大越明显。工业设备必须做运动学标定。
其次,"θ₂ 是绝对角度"是常见混淆。本工具的 θ₂ 是相对角,即相对连杆 1 的旋转。在一些教材中使用绝对角 θ₂' = θ₁ + θ₂。引用论文或 CAD 数据时务必确认定义。
最后,"奇异点只是数学概念"是非常危险的想法。靠近奇异点时所需的关节速度急剧增大,伺服易饱和并产生振动甚至失控。把 θ₂ 推到 0° 或 180° 附近,右下方热图会变暗,这就是警告信号。路径规划要么避开奇异区,要么使用阻尼最小二乘法(DLS)进行稳定化。