机械臂逆运动学(IK)入门：两连杆几何解到六轴，对不准的四个坑

自己用舵机攒机械臂的朋友，八成卡过同一关：同一个目标点，手动拨半天能对准，一旦让程序去算角度，臂就歪到天上去，甚至猛甩一下。先说结论：十有八九不是舵机不够力，而是逆运动学（IK）这块没写好。今天把入门这关掰开讲清楚。

逆运动学到底是啥

机械臂控制分两半。正运动学是"已知每个关节角度，求末端在哪"——这个永远只有一个答案，好算。逆运动学反过来，是"已知想让末端到达的坐标和姿态，反推每个关节该转到多少度"——这才是难点，因为它可能一个解、多个解、甚至没解。

理解关键：你给的是末端够不着的点，那确实没解；目标点落在工作空间里，往往有不止一种摆法。程序得自己挑一个。

从两连杆几何解起步

先用最简单的平面两连杆臂练手，别一上来就啃六轴。两根连杆长是 L1、L2，目标点坐标是 (x,y)，基建一条三角形，用余弦定理求第二关节角：cos(θ₂)=(x²+y²−L1²−L2²)/(2·L1·L2)。这个cos值一旦越出−1到1，acos就会返回NaN，末端就会甩出个垃圾角度——这就是为什么够不着的目标常引发猛甩而不是拒绝动作。

所以写代码第一步，永远是先判可达性：目标到基座的距离d必须落在|L1−L2|和L1+L2之间，越小越稳。用atan2而不是atan，是最常见的一个坑——atan分不清目标在前还是在后镜像，会让臂只在一个象限正常、另外几个象限镜像反着动。

六轴怎么解：球腕解耦+数值法

六轴全靠几何法会头大。好在真正的六轴臂末端三个关节轴通常交于一点，这叫球腕结构，可以把问题拆成两半：先用几何法解前三个关节，把腕心位置定下来；再解后三个关节的朝向，用欧拉角拆出来。这套封闭解相对又快又稳。

如果臂不是标准球腕，或者要带避障、限位优化，就得上数值法。ROS2里的MoveIt内置KDL、TRAC-IK等求解器，靠雅可比矩阵迭代收敛，一般一次几毫秒，适合不做实时闭环的场景。

新手最容易翻的四个坑

第一个坑，忘了先判可达性，NaN一路传到舵机命令里，臂就抽风。第二个坑，多解不选——同一目标有两组及以上合法姿态，必须选离当前关节角最近的那组，不然路径走到一半求解器突然切换分支，臂会高速大角度翻转，既吓人也可能伤硬件。

第三个坑，不管关节限位。数学上算出的角度可能超出舵机物理范围，不校验就发指令，等于让臂去撞限位。第四个坑直接导致"算对了却落不到点上"——数学坐标系和舵机的零点、转向对不上，每个关节得单独标定offset和正反方向。臂动起来很顺但总偏一点，几乎都是这里，不是数学问题。

直线运动要在路上反复解

想让末端走直线，不能只在起点和终点各解一次，然后让关节角线性过渡——那样末端是画弧线的。正确做法是在笛卡尔空间插出中间点，每一步都重新解一次IK。实际操作会发现：越靠近工作空间边缘，同样的末端速度要关节转得越快；而且一条直线可能中途穿出可达区，所以必须在每一步都查状态，不能只在两端查。

总结

逆运动学入门顺序应该是：两连杆几何解跑通 → 加内部解校验 → 处理多解和限位 → 标定伺服零点方向 → 再上六轴或数值法。把这几个坎排掉，机械臂才算"真听你话"，而不是瞎转。别急着追新硬件，先把IK这关过了，后面抓取、循迹都好办得多。