二连杆逆运动学可视化

为什么会有两个解？

末端位置只约束了两个方程 (x, y)，但机械臂有两个关节角——方程组是三角方程，cosθ₂ 和 sinθ₂ 的组合给出 θ₂ 的两个根（±），分别对应肘部朝上和朝下。工业机械臂出厂就选定一种肘部构型，逆解时另一个根通常被舍弃。

雅可比是什么？

J(θ) 把关节速度映射为末端速度：ẋ = J·θ̇。二连杆的 J 是 2×2 矩阵，它的两个列向量就是图中两条箭头——列向量张成的面积越大，机械臂在这个方向上越灵活；奇异点处两列共线，面积归零。det(J)=0 就是奇异点的判据，也是「可操作度」指标的来源。

奇异点：机械臂的死角

• 伸直奇异（θ₂=0°）：两连杆共线，末端无法沿臂方向产生速度——想往「更远」使劲，雅可比却说这个方向速度为零。此时需要的关节速度趋于无穷。
• 收拢奇异（θ₂=±180°）：两连杆重叠，末端卡在肩部附近，同样丢失一个移动自由度。
• 工程含义：路径规划必须绕开奇异构型，否则轨迹跟踪会要求无穷大关节速度，真实电机直接饱和丢失轨迹。6 轴机械臂还有腕部奇异等更多种类。

逆解在真机器人上怎么做？

解析解（本工具）：特定构型的机械臂能推出闭式公式，微秒级、精确。数值解（雅可比伪逆 / IK 服务）：任意构型通用，迭代收敛，MoveIt / Pinocchio 里的做法。实际机器人还要考虑关节限位、碰撞、冗余自由度优选——解析解给出候选，上层再筛。