正运动学：从 DH 参数到乘积指数（PoE）公式（完整版）

本文是《机器人炼金术 · 进阶配方》第 07 期完整版。相比免费版，本文额外包含：DH 四参数完整推导与坐标系约定陷阱、PoE 指数映射闭式解全程推导、fk_demo.py全量代码逐句解释、三种 FK 实现的实测对比与选型分析、三个应用场景的"现象→根因→解法→验证"完整拆解。一、直觉层：一个方向有公式，一个方向没有机器人学里有两类问题长得很像，难度天差地别：正运动学（FK）：已知所有关节角q，求末端在哪——有闭式公式，代入就算；逆运动学（IK）：已知末端想去哪，求关节角——一般没有通用闭式解，只能数值迭代（第 08 期主题）。为什么不对称？因为 FK 本质是多项式求值：连杆长度乘上 cos/sin 再累加，代入即得。IK 是多项式求根：把 FK 方程反着解，未知数躲在三角函数里，次数一高就没有求根公式（阿贝尔定理的领地）。这个不对称决定了工程分工：FK 便宜到每个控制周期都算几千遍，IK 贵到要专门规划。同一个 FK，业界有两套建模哲学：DH 参数（Denavit–Hartenberg，1955）PoE