导纳控制的参数整定解析

导纳整定没有高深的理论门槛，核心是从过阻尼出发，看力曲线说话，分段调试，记录分析。对于低速恒力清洁，一阶纯阻尼 + 阻尼椭圆 + 适当限幅，就是可以实践。

导纳控制的参数整定是三分理论、七分实验的工作，对于清洁机器人这种低速恒力贴合场景，整定难度低于高速力控，且有一套成熟的工程方法论可循。

一、明确整定目标与评估指标

1.1 整定目标

在清洁场景中，导纳控制的终极目标可以归结为：

1.2 评估信号

• 法向力信号 Fcontact,z（工具坐标系 Z 轴）是核心观察量。
• 辅助观察：位置修正量 Δx的曲线、关节速度、力矩反馈。
• 推荐工具：将力信号、位置修正量、期望力、实际力在一张图上滚动显示，便于直观判断。

二、导纳参数整定流程

准备阶段：确定导纳结构

在整定前，先根据任务选择导纳的阶数：

建议一阶纯阻尼导纳（DΔx˙=Ferr），理由如下：

• 参数只有一个 D，整定难度最低。
• 无条件稳定（只要 D>0）。
• 接触时无惯性项，不会产生冲击力。
• 低速清洁对响应速度要求不高，一阶足够。

阶段1：调试（无接触）

目的：在不受接触力干扰的情况下，先验证导纳修正量的行为是否符合预期。

步骤：

1. 机械臂末端悬空，不接触任何物体。
2. 人为给一个力传感器偏置（或用手轻推传感器），使 Ferr不为零。
3. 观察导纳输出的位置修正量 Δx是否按预期方向移动（力推方向 = 移动方向）。
4. 松开手，修正量是否回到零附近。

通过标准：

• 移动方向与力的方向一致，无反向或对角线串扰。
• 修正量平滑，无跳变、无高频抖动。
• 系统能静默等待，不产生自发漂移。

阶段2：软材料接触试贴（关键阶段）

目的：在真实接触前，用软材料（海绵、橡胶）模拟釉面，完成参数粗调。

步骤：

1. 设定期望力 Fdes：先从一个较小值开始（如 1N），后续再升至目标值。
2. 选择初始阻尼 D：取一个偏大的保守值（如 500 Ns/m），确保过阻尼。
3. 执行趋近→接触→保持：
   • 低速（5~10 mm/s）接近软材料。
   • 接触后观察力曲线。

整定判断：

推荐初始值经验公式：

其中 v_approach是期望的稳态修正速度，例如 Fdes=3N，希望力误差为 3N 时修正速度为 0.005 m/s（5mm/s），则 D0=3/0.005=600Ns/m。

阶段3：真实釉面精调

目的：在软材料调通的基础上，针对真实刚性釉面做最终微调。

与软材料的关键差异：

• 釉面刚度远高于软材料，接触力对位置变化极其敏感。
• 需要更大的阻尼来维持稳定。
• 需要考虑釉面曲率变化带来的法向偏移。

步骤：

1. 在平直釉面区域（如座圈）先跑直线贴合，微调 D 至最佳。
2. 再在曲率变化区域（内壁拐角）测试，观察跟踪性能。
3. 如果拐角处力波动大，可考虑：
   • 降低切向速度。
   • 使用阻尼椭圆（法向高阻尼、切向低阻尼）。
   • 引入前馈（分段均值前馈或空间学习滤波）。

阶段4：全流程联调

目的：验证从趋近→贴合→跟踪→退出全过程的参数一致性。

关注点：

• 高速趋近→柔性逼近的切换是否平滑无冲击。
• 贴合后从平坦区进入拐角区，力是否稳定。
• 退出时力是否平滑降至零，无反弹。
• 不同清洁模组（硬刷 vs 软布）是否需要差异化参数。

调试策略：

• 先固定切向轨迹参数（速度、路径），只调导纳参数。
• 导纳调好后，再优化切向速度。
• 最后做全流程回归测试。

三、最佳实践

1. 从过阻尼出发，逐步收紧

原则：永远从大阻尼开始，逐步减小到刚满足响应速度要求即可。 理由：过阻尼只会慢，不会坏。欠阻尼会振荡、划伤釉面、甚至损伤机械臂。

2. 限幅是安全网

导纳输出的位置修正量 Δx必须有限幅：

• 下限：0（不允许反向穿透）。
• 上限：根据清洁模组的最大行程（如 5~10mm）。

限幅过大容易导致力冲击，限幅过小会导致位置修正不足、力达不到期望值，建议先设 5mm，再根据实际微调。

3. 分段参数策略

不同阶段使用不同导纳参数：

可通过状态机在阶段切换时动态更新 D，切换时做斜坡过渡（如 50ms 内线性变化）。

4. 阻尼椭圆的应用

如前所述，在工具坐标系下设置对角阻尼矩阵：

• dz（法向）：大，保证稳定性。
• dxy（切向）：小，保证跟踪灵活性。
• 初始比例建议 dz/dxy=3∼5。

5. 速度与阻尼的匹配

核心原则：切向移动速度越快，法向阻尼需要越大。 量化关系：力误差恢复时间 τ≈D/Kenv，其中 Kenv 是环境刚度。釉面很硬（Kenv大），所以 τ很小，即使 D较大也能快速响应。但如果切向速度快，曲面变化产生的法向扰动频率高，就需要更高的 D 来快速衰减。

工程经验：

• 切向 20~50 mm/s：D = 200~400 Ns/m 足够。
• 切向 80~150 mm/s：D = 500~800 Ns/m 更稳妥。

6. 滤波与导纳带宽的匹配

力信号的低通滤波截止频率要远高于导纳环的响应带宽。

• 如果滤波太强（截止频率太低），力信号滞后，导纳响应变慢，容易振荡。
• 一般建议：滤波截止频率 ≥ 5× 导纳带宽。
• 清洁导纳带宽约 1~5 Hz，滤波截止频率取 30~50 Hz 是安全的。

7. 在线监测与记录

在调试阶段，必须记录以下数据用于离线分析：

• 力传感器原始值、补偿后值。
• 导纳输出的位置修正量。
• 关节实际位置/速度。
• 状态机阶段标志。

每次调试后，画出时间曲线，标出问题发生时刻，便于定位是导纳参数问题、传感器补偿问题还是轨迹规划问题。

四、常见问题排查表

五、总结备忘

整定顺序：

1. 确定导纳结构（一阶纯阻尼）。
2. 自由空间验证方向正确性。
3. 软材料粗调，从大 D开始。
4. 真实釉面精调。
5. 全流程联调。

6. 经验初始值（直接可用的起点）：

• 一阶导纳阻尼 D：300~500 Ns/m（法向）。
• 切向阻尼 dxy：100~150 Ns/m。
• 力传感器低通截止频率：30 Hz。
• 位置修正限幅：±5 mm。
• 接触检测阈值：0.5 N。
• 柔性逼近速度：5~10 mm/s。

这些值可以在半小时内跑通一个基本的恒力贴合闭环，然后基于实际力曲线做针对性微调。