导纳MDK参数调节步骤及原理

经过“最坏情况”（最大曲率×最高清洁速度）调试的导纳参数，足以作为整个清洁任务的统一交互特性。如果一组 M-D（K=0）参数能在不同曲率下保持一致的贴合效果，这跟“曲面具体长什么样”无关，而是取决于“力控系统的动态响应能力”是否全面碾压“曲面变化带来的扰动”。

换句话说，只要机械手反应得比曲面变化快，就能在任何形状上如影随形地保持恒力。下面从原理上拆解这种“一致性”从何而来，再给出在清洁场景下，确定合适参数的具体步骤。

一、效果一致的根源：力控带宽 > 曲面扰动频率

导纳控制器本质上是一个力伺服系统，它不关心位置命令是多少，只关心力误差并以最快速度消除它。

曲面变化，对力伺服系统而言，只是一个外部法向位移扰动 d(t)，移动得越快、曲率变化越剧烈，这个扰动信号的频率就越高。

但只要力控系统带宽 fbw远高于这个扰动频率，就能在扰动把力误差拉大之前，迅速输出位置修正把它抵消掉。此时，无论曲面是平的、弯的还是拐角，力误差都会被牢牢压制在容许范围内，表现自然一致。

定量来看：

• 扰动频率 fdist≈v/2πR （v为切向清洁速度，R为局部曲率半径）
• 力控带宽 fbw≈1/2πτ，其中时间常数 τ≈M/D（K=0 时）

当 fbw≫fdist 时，参数效果一致。

以内壁为例： 假设最小曲率半径 R=40mm的拐角处，以 v=80mm/s的较高速度清洁。 fdist≈80/(2×3.14×40)≈0.32Hz。 即使留出 10 倍裕量，力控带宽也只需做到 3.2Hz左右，而一套调试得当的导纳控制系统，做到 5−10Hz带宽非常轻松。

这就是一组固定参数足以通吃所有曲面的物理基础——曲面的“多变”，对控制器而言，变化得太慢了。

二、决定效果一致性的三个关键要素

既然效果一致不依赖曲面形状，那它真正依赖什么？

1. 力控带宽（由 M 和 D 决定） 这是根本，带宽越高，能应对的扰动频率越高。K=0 时，导纳环可近似为一阶低通，其时间常数 τ=M/D。减小 M 或增大 D 都能提高带宽，但它们的配比会影响稳定性和噪声敏感度。
2. 阻尼比 ζ（决定是否平滑无冲击） 即使带宽足够，如果 M 和 D 的比例不当，导致系统欠阻尼（ζ 小），贴合时就会产生过冲和振荡力，直接划伤釉面或出现抖动。在清洁场景中，过阻尼（ζ>1）是必须保证的前提。对于 K=0 的系统，阻尼比可以近似由

来约束，其中 Ke是接触环境的刚度。虽然 K=0，但接触刚度依然会影响闭环特性，D 必须足够大来耗散能量。

1. 内环位置伺服带宽（硬件基础） 导纳环算出的位置修正，最终要靠机械臂的关节电机去执行。如果机械臂自身的位置环带宽不够，导纳环的理想动态就会被削弱。机构有高带宽的小行程俯仰关节，这是巨大的优势，可以承担高频修正，保证导纳环整体特性。

三、清洁场景下，参数整定实战步骤

现在用最直接、最工程的方法，找到那套“以不变应万变”的参数。整个过程始终设 K=0。

第1步：确定最坏工况点

选定你最想用的最高清洁速度 vmax，并找到整个几何体中曲率半径最小、变化最急的区域（通常是排污口边缘或内壁拐角），测量或估算其最小曲率半径 Rmin。

第2步：设定力控性能目标

• 目标恒力 Fdes=3N（根据你的模组设定）
• 允许力波动 ±0.5N
• 绝对禁止超调（无过冲接触）

第3步：从“安全阻尼”入手，定 D 后调 M

反向来，因为在这个场景下稳定性压倒一切。

1. 先确定一个“绝对粘稠”的阻尼 D。 想象末端模组浸在厚蜂蜜里运动，希望即使直接撞击釉面，它也能瞬间减速，毫无反弹。 找一个临界的 D 值：让机器人在自由空间，给它一个阶跃的期望力 Fdes=3N（即突然命令它以 3N 的力去压一个不存在的物体），观察实际力的变化和末端移动。
   • 逐渐增大 D，直到末端的移动变成非常平滑、缓慢的爬行，完全看不出突然启动和惯性冲量。
   • 此时记录这个 D 值，它提供了基础的安全阻尼层。比如，可能得到一个 D=200 Ns/m。
2. 引入 M 来调节“迟钝度”。 在上面那个超稳的 D 下，M 过小会让系统对传感器噪声过于敏感，末端高频微颤；M 过大则响应迟钝，在曲面变化时力误差可能增大。
   • 从一个较小的 M 开始（比如 M = 末端模组真实质量的 1-2 倍，假设 2kg），观察贴合真实釉面。
   • 如果感觉力波动大、有高频异响，适当增大 M，以惯性过滤噪声。
   • 如果清洁到内壁拐角时，力误差会短暂地明显增大（如超过 0.5N），说明响应慢了，则适当减小 M 或 减小 D（优先减小 D，因为减小 D 可以提高带宽且不会损害对噪声的滤波，但要注意别低于稳定下限）。

第4步：在真实最坏工况下闭环验证

将当前的 M 和 D 参数写入机器人，以最高的 vmax反复清洁那个曲率最急的拐角。

• 观察并记录六维力传感器数据。
• 通过标准：力曲线始终在 3±0.5N 范围内，没有高频振荡，接触瞬间没有超过 3.5N 的尖峰。
• 若不合格：力误差大则减 M 或减 D；有振荡尖峰则加 D 或加 M。

第5步：平坦区域复核

用调好的参数清洁座垫区域，因为扰动极小，只要上一步参数是过阻尼、无振荡的，这里表现一定更加平稳。如果出现极细微的高频抖动（可能是机械共振被激发），可在此参数基础上微增 D，再回到最坏工况确认一次，直到找到兼容点。

更直观的调试心法

可以把调参想象成配置一个虚拟弹簧阻尼缓冲器，但它跟在你手上：

• D（阻尼）是“手劲粘稠度”：先调到感觉你的手像插在沥青里，任何突然的推力都只能让手极缓慢移动。这是安全底线。
• M（质量）是“手的重量”：在保证安全（足够 D）的基础上，逐渐减轻手的重量（减小 M），直到觉得手能灵活跟随曲面起伏，但又不会因为自己手抖而乱晃。这就是敏捷上限。

这套在“安全”和“敏捷”之间找到的平衡参数，就是清洁机器人统一的“触觉手感”。它能无差别地适应平面和曲面，因为它的反应速度已经决定了它看任何曲面都是“慢动作”。

最终你会发现，这套参数值其实就是在 “绝对无冲击”和“足够快跟随” 两个约束下，在 M-D 平面上找到的一个小范围交集。而清洁这种低速、恒力任务，让这个交集非常宽广，非常容易命中。