本文来自我在 MuJoCo 异构机器人工作站项目中的一次真实排查总结。文中的数字来自本地已有的仿真报告和日志；

一、一个看似漂亮的结果

最初的报告看起来相当顺利：人形机器人下蹲时，双手的目标位置始终贴着托盘把手。抓取门限设为 2 mm，日志中的最坏手—把手距离约为 0.001 mm；在 0.20 m 下蹲深度处，tray_held 也是 PASS。

如果只看这一行，很容易得出结论：手没有离开把手，机器人抓住了托盘。

但复核时，我把“控制器希望手到哪里”和“仿真里的手实际上到了哪里”分开测量。同一段运行、同一个工况下，目标手部位置距离把手只有 0.0010 mm，实际手部位置却距离把手 187.7 mm。

这不是精度差一点，而是两个完全不同的事实。前者说明逆运动学求出了一个漂亮的目标；后者说明机器人根本没到那里。

二、为什么原来的 PASS 会骗人？

原判据量的是命令姿态下的手—把手距离。简化后，相当于：

commanded_gap = np.linalg.norm(
    hand_position_from_ik(q_commanded) - handle_position
)
tray_held = commanded_gap <= 0.002  # 2 mm

这个值能回答“求解器给出的关节目标，是否把手放在把手附近”，却不能回答“电机和接触动力学作用后，真实手部是否到位”。

MuJoCo 中的控制过程存在一条不能跳过的链：

把手位置 → IK 求解目标关节角 → 控制器输出 → 接触/动力学仿真 → 实际关节状态与手部位置

旧判据停在“求解目标关节角”这一步，就把它当成了整条链的结果。实际运行中，手指与托盘发生物理接触，手臂被挡住；PD 控制器继续追目标，但手没有跟上。证据审计记录了多个手指近端与托盘的持续接触，命令位置与实际位置之间形成了约 187.7 mm 的跟踪偏差。

还有第二层问题：为了把下蹲和托盘自由运动分开诊断，旧实验在每个控制步把托盘重置到初始位置。报告中的 tray_pinned: true 正是这个意思。它能帮助定位问题，但不能拿来证明机器人真的抓住或搬起了托盘。

三、把三个距离分开，假成功就藏不住了

本次证据审计在 0.20 m 下蹲工况下，对比了两种设置：

测量项	临时固定托盘的诊断运行	托盘自由运动的运行
命令手部位置 → 把手	0.0010 mm	1083.8 mm
实际手部位置 → 把手	187.7 mm	1132.6 mm
命令手部位置 → 实际手部位置	187.7 mm	311.9 mm
托盘位移	0 m	1.298 m

这里的 187.7 mm 是审计中同一工况的对照测量，不是整段运行的最大值。修正后的正式报告按整段运行统计：0.10 m 下蹲工况的最大实际手—把手距离约为 200.9 mm，而最大命令距离仍只有约 0.001 mm。两组数字的统计口径不同，不能混写成同一个“最大距离”。

托盘自由运动时，问题更明显：托盘会离开原位置，而旧版如果继续拿先前保存的把手坐标作为目标，IK 甚至可能对着一个已经不存在于原地的“把手”收敛。所以，除了手的位置，还必须重新读取把手位置，并检查托盘自身的位移。

四、我们怎样修改判据

修正不是把 2 mm 阈值调大，而是把“命令值”和“实际值”拆成两个字段。关键代码逻辑如下（摘取判定思路，非可独立运行脚本）：

# q_cmd 来自 IK；它描述控制器希望达到的姿态。
commanded_gap = distance(hand_from_ik(q_cmd), current_handle)

# 仿真步结束后，从 MuJoCo 的实际状态读取手部位置。
step_simulation()
actual_gap = distance(hand_from_sim_state(data), current_handle)

rows = {
    "tray_held_commanded": commanded_gap <= 0.002,
    "tray_held": actual_gap <= 0.002,
    "tray_in_place": tray_shift <= 0.002,
}

项目中的实际实现是在每个物理步结束后，从 MuJoCo MjData 的位姿状态计算双手的位置，并记录整段运行的最坏距离；原来的结果改名为 tray_held_commanded，新的 tray_held 才由仿真状态裁决。最终的 holds 也必须包含这个新的实际状态判据。

修正后的本地报告中，可以看到这样的结果：

hand_gap_max_m          = 0.002
worst_gap_m             ≈ 0.000001     # 命令姿态：约 0.001 mm
worst_actual_gap_m      ≈ 0.2009       # 实际状态：约 200.9 mm
tray_held_commanded     = true
tray_held               = false
tray_pinned             = true
holds                  = false

也就是说，求解器通过了，但物理执行没有通过。在这套修正判据下，所测下蹲深度均未达到该实验的抓取门限，原先给出的 D_MAX = 0.20 m 不能再作为“抓着托盘下蹲”的结论；修正报告将它记为 D_MAX = None。

五、一个抓取实验到底应该验收什么？

这次排查让我把四件经常被混为一谈的事拆开：

1. IK 收敛：能否求出目标关节姿态。
2. 实际到位：仿真步之后，手是否真的靠近当前把手。
3. 真实持物：手指是否建立有效接触，托盘是否在不被“钉住”、不靠隐藏约束的情况下随手抬升并保持。
4. 任务完成：能否安全放下、退出，并把托盘交给下一机构。

第 1 项通过，不会自动推出第 2 项；第 2 项通过，也不等于第 3 项通过。即使检测到接触，也还要排除“手只是把物体撞走了”的情况。

在项目的另一条独立人形托盘诊断链中，确实记录过手指闭合、双手接触、托盘抬升 0.1263 m 并持续持有 14.0 s。但那是在声明好的固定工装位姿、无视觉和位姿扰动的独立世界中完成的诊断实验，不能据此宣称当前合并工作站已经完成跨机器人供盘。

六、给做仿真项目的一个检查清单

如果你的机器人日志也显示“抓取成功”，不妨先问几个问题：

• 距离是从 q_commanded 算的，还是从仿真运行后的 qpos、site_xpos 等实际状态算的？
• 把手位置是否每步从当前物体状态更新？
• 物体有没有被重置、固定、焊接，或者被测试脚本悄悄写回初始位姿？
• PASS 对应的是“接近目标”“接触物体”“抬起物体”，还是“完成整个任务”？
• 报告是否同时保存失败样本，而不只保存一张成功截图？

这次问题最有价值的地方，不是把一个 PASS 改成了 FAIL，而是把验收对象从控制器的愿望换成了仿真世界实际发生的事。机器人项目里的假成功，往往就藏在这两者之间。