知道关节怎么转，才知道手会到哪里

两根连杆，已经足够说明正运动学

想象从肩膀到肘部，再从肘部到手的两段箭头。手的位置是这两段位移之和。肘关节转动改变的是第二段相对第一段的方向，而不是相对房间的方向。许多实现错误就来自把这两种角度混在一起。

教学设定：两根杆各长 0.3 m，q₁=0°、q₂=90°。第一段向右 0.3 m，第二段向上 0.3 m，所以末端在 (0.3, 0.3) m。换成 q₁=90°、q₂=−90°，末端仍在同一位置，但第二根杆朝向变了。“同一个位置”不代表“同一个位姿”。

↔ 左右滑动查看图中细节

坐标不是标签，而是计算合同

“杯子在右前方 20 cm”必须说明相对谁：相机、基座还是夹爪？在三维空间中，一个刚体位姿包含旋转与平移。齐次变换把两者写在同一个 4×4 矩阵中；末行让平移能与旋转一起使用矩阵乘法组合。

旋转和平移一般不可交换。先在世界里向右走，再绕原点转身，与先转身再按原来的坐标向右走，不会落在同一地点。对机器人，交换变换乘法顺序可能让本来正确的目标跑到完全不同的区域。

三维姿态可用旋转矩阵或单位四元数表示；欧拉角直观，但存在表示奇异性。不要把欧拉角的万向节锁和机械臂雅可比的奇异配置当作同一问题：前者是姿态参数化的缺陷，后者是本体在某配置下丢失瞬时运动方向。

逆运动学可能无解，也可能不止一个解

如果右侧余弦值超出 [−1,1] 且并非微小浮点误差，目标不在几何可达范围。两杆各长 0.3 m 时，(0.7,0) m 不可达。对可达的 (0.3,0.3) m，前面的两组角度就是两个位置逆解；若再要求末端朝向固定，可能只剩一个，或一个也没有。

更复杂的机械臂常用数值迭代：从初始配置出发，计算目标误差，用局部线性模型产生小的关节修正，再重新计算。初值影响收敛与分支；步长过大可能跨过有效区域。位置误差和旋转误差还应使用一致且明确的度量与权重，不能直接把米和角度随便相加。

手臂伸直时，有些方向突然动不了

在 q₁=q₂=0 的完全伸直配置，两根杆都沿 x 轴。很小的转动首先带来 y 方向速度，无法产生一阶的 x 方向末端速度。它不是“机器人坏了”，也不是永远不能向内缩；机器人可以先弯曲，再获得新的运动方向。

接近奇异点时，为了实现某个末端速度，反求出的关节速度可能非常大。阻尼最小二乘用正则化减少爆大的速度，但代价是末端跟踪误差；它不会凭空恢复机械结构缺失的方向。应结合速度限制、路径调整与重新选姿态处理。

这也是动作模型不能只学“正确坐标”的原因：同一个末端目标可能对应可执行性完全不同的姿态。机器人需要把几何解放回规划、控制和安全约束中，才能真正动起来。

把这一层放回完整机器人

返回具身智能知识地图，或沿本专栏继续展开：

• 拆开机器人：传感器、关节与计算：身体决定观察、动作与能力边界。
• 动力学与力控：接触之后怎么办：质量、惯性、反馈和接触约束共同决定运动。
• 运动规划：目标不等于安全路径：配置空间、碰撞检测、轨迹与执行约束。