导纳控制的MDK参数详解

导纳控制的三个参数的名字直接来源于经典力学，因为导纳控制的核心就是用软件模拟一个真实的物理系统——弹簧-阻尼-质量系统。机器人末端要表现得就像这个物理系统一样，所以参数就借用了物理元件的名称和特性。

理解它们最好的办法，就是回到核心方程：

MΔx¨+DΔx˙+KΔx=Fdes−Fext

左边是虚拟物理系统产生的“内力”，右边是“外力误差”。下面逐个拆解。

一、虚拟质量 M —— 惯性

物理原型：一个质量为 M 的滑块。 原理：力会导致质量加速，且质量越大，同样的力产生的加速度越小。牛顿第二定律 F=Ma，这里 a=Δx¨。

在导纳控制中的效果：

• M 大 → 惯性大，机器人末端“沉甸甸”。当接触力突然变化时，它不会猛地加速，而是缓慢地把力误差转化为运动。对高频力噪声（传感器毛刺）有很好的滤波效果，但响应会迟钝。
• M 小 → 惯性小，末端灵活，很小的力误差就能让它快速移动。但如果太小，传感器上的微小抖动都会被放大成末端振动，导致“发飘”或不稳定。

类比举例： 想象闭着眼用手推一个物体，但手上分别戴着：

• M=大：厚棉手套，里面还灌了铅。你感觉到推力变化后，手很重，很难快速收放，一些小石子硌到也感觉不到。
• M=小：徒手。指尖极其灵敏，一丁点力变化马上缩手，但也容易因为紧张而手抖。

在清洁任务中，M 决定了对釉面不平度的“包容性”：稍大一点的 M 可以让刷头平稳滑过微小凹凸，而不会把每个凸点都当成力冲击。

二、虚拟阻尼 D —— 粘性

物理原型：一个阻尼器（汽车减震筒）。 原理：阻尼力与速度成正比 F=Dv，且始终与运动方向相反，消耗动能。

在导纳控制中的效果：

• D 大 → 虚拟的“蜂蜜环境”，末端运动像被粘稠液体包裹。当力误差驱动末端移动时，速度越快，阻尼阻力越大，因此运动速度会被迅速抑制，防止超调和振荡。它提供了稳定性，是系统稳定的主要贡献者。
• D 小 → 末端响应迅速，但一旦运动起来，由于缺乏能量耗散，很容易在目标点附近来回摆动（欠阻尼振荡），接触釉面时表现为反复回弹、力值波动。

在力贴合中的独特价值： 当设 K=0 时，系统相当于仅靠 M 和 D 来工作。此时 D 的作用尤为关键：力误差会让末端持续加速（M 决定加速度大小），但 D 会产生与速度成正比的阻力来平衡掉部分力误差。当达到期望力（误差为零）时，速度会因 D 的消耗而最终归零，停止在一个新的位置，这个位置恰好是力平衡的位置——这就是恒力无静差的物理本质。

类比举例：

• D=大：你的手浸在一大桶蜂蜜里推东西。无论你多用劲，手都只能缓慢匀速移动，一松劲马上就停下来，绝不可能冲过头。
• D=小：你的手在空气中推东西。稍微一使劲就窜出去，很容易撞上目标后反弹回来。

贴合时，需要较大的 D 来让接触过程像“慢动作”一样平缓，确保刷头轻缓地贴上去，而没有冲击力。

三、虚拟刚度 K —— 弹性

物理原型：一根弹簧。 原理：弹簧力与位移成正比 F=KΔx，总是试图把物体拉回平衡位置。

在导纳控制中的效果：

• K 大 → 强弹簧。当末端偏离预设参考位置时，会产生强大的恢复力，想把末端拉回来。如果用在力控制上，这意味着必须有持续的位置偏差才能维持力，且力会随偏差改变——无法实现恒力。
• K=0 → 没有弹簧。末端偏离参考位置不会产生任何恢复力，外力完全由 M 和 D 的动态平衡来匹配。这是实现真正恒力贴合的必要条件。

为什么恒力贴合必须 K=0？ 假如 K>0，当曲面内凹，刷头需要“伸进去”才能维持 3N 的力。这时因为伸入导致 Δx 增大，弹簧想把刷头拉回来，就需要更大的外力才能压住它——结果力就被动变化了。K=0 就破除了“位置-力”的绑定关系，使机器人在任何位置都能输出同一个力。

类比举例：

• K>0：拿着刷子，刷子和手之间连着一根弹簧。要维持 3N 压力，必须恰好把弹簧压缩到特定长度。一旦表面起伏，弹簧长度变化，压力就变了。
• K=0：刷子直接握在手里，但你只看手上的压力传感器。你可以让手跟随表面任意移动，同时保持压力不变——这就是恒力。

四、综合类比：一个完整的物理替身

把导纳控制器想象成机械臂在末端“安装”了一个虚拟的滑块-阻尼-弹簧小车，工具再装在小车上：

釉面 <——[清洁模组]——[虚拟小车：弹簧 K, 阻尼 D, 滑块质量 M]——<机械臂手腕>

• 当模组碰到釉面，接触力通过小车传给手腕。
• 力误差（期望力 - 实际力）就是这个小车受到的“驱动力”，它会推动质量 M 加速。
• 阻尼 D 会吸收动能，让小车不会乱冲。
• 弹簧 K（如果存在）会试图把小车拉回机械臂手腕的原始参考点。

机械臂手腕只是忠实地跟随小车的运动（通过位置内环），所以从外面看，整个刚硬的机械臂+工具就表现得像这个小车一样柔顺、稳定。

在清洁任务中的参数心智模型

• M = 刷头的“钝感度”：让它忽略釉面的细微凹凸和传感器高频杂波，运动平滑。
• D = 接触的“粘稠度”：保证接触过程无冲击、无反弹，像一片羽毛飘落到水面上。
• K = 0 = 打破“位置—力”的固定关系：使刷头能像磁悬浮一样无约束地跟随曲面，同时保持恒力。

整定原则就是：用较大的 D 确保无振荡无超调，用适中的 M 平衡灵敏度和平滑性，K 置零实现真正的恒力柔顺贴合。这套虚拟物理系统的魔力在于，它能把原本僵硬、位置至上的工业机器人，变成一个有触觉、知进退的“柔软之手”，完美适合釉面这种既需精密又需轻柔的场景。