如何写机械臂逆运动学(IK)函数
哪些公司问过
答案要点
- 输入目标位姿和初值,输出关节角及收敛标志
- 每轮 FK 求当前位姿,位置误差直接相减,姿态误差用 R_d·R^T 的轴角表示
- 阻尼最小二乘 dq = J^T(JJ^T+λ²I)^(-1)e,奇异附近比伪逆稳定
- 每步限位裁剪,误差小于阈值或达最大迭代次数时退出
- 球腕 6 轴可用解析解,多解按离当前构型最近或关节限位筛选
易错点
- 姿态误差直接对欧拉角做差,跨越角度边界时出错
- 直接用伪逆,在奇异位形附近关节增量会爆炸
- 不处理未收敛和关节限位,返回不可执行的解
面试官常见追问
- 写一个求机器人雅可比矩阵的函数。
- 解析解和数值解怎么取舍?
- 冗余机械臂的 IK 有什么不同?
完整的口述示范答案、每个追问的参考回答,在启面刷题中心查看;也可以让 AI 面试官用语音按这道题连环追问你。