机器人接触瞬间切换的触觉自定位方法

一个典型的“最后一厘米”定位问题，也是机器人从“粗定位”进入“精细交互”的关键衔接点，先梳理约束，再给出方案。

一、当前约束与挑战

• 先验模型不可靠，无法用示教点或离线模型。
• 末端相机可能盲区、污水遮挡或光照不稳。
• 目标是快速定位到距釉面约 5mm 的非接触站位点，作为“低速柔性逼近阶段”的起点。

硬性要求是快速、不依赖视觉、不损坏釉面。幸运的是，系统具备核心安全能力：过阻尼导纳控制 + 小行程柔性俯仰关节。因此，最优策略不是“完美测量”，而是“安全触碰+回退”。

二、实现方案：先验初定位 + 触觉精定位（双级逼近）

第一级：粗定位到“大概率安全区”

传感器：移动底盘的 2D 激光雷达 + 机械臂关节编码器。

• 底盘激光扫描轮廓，识别大致中心轴和朝向。
• 驱动底盘和 SCARA 大臂，将末端工具送至 “上方、深度大致正确” 的空旷区域（如上方 5~10cm、内壁外侧 10cm 处），保证绝不触碰。
• 这级定位只需保证末端在某个足够大的“初始桶”内（比如 10cm 误差），普通激光 SLAM 完全足够。

第二级：基于工具端的触觉逼近（核心创新）

此时，末端已处于内部“绝对安全”的大致位置，但精确 5mm 未知。直接用工具模组本身作为探针，利用它已有的六维力传感器和导纳柔顺能力，执行一次无损伤探测运动。

步骤：

1. 激活探测导纳模式 设定一个极低的接触探测力 Fprobe=0.3 N（远低于清洁力 3N，且釉面无损伤）。 导纳参数：K=0，M 中等，D 较大（确保临界阻尼）。 给末端施加一个极慢的恒定法向速度前馈 vprobe=5 mm/s，方向大致指向预估的釉面。
2. 接触瞬发判定 当 Fext>Fprobe，立刻在 1~2ms 内触发：
   • 停止速度前馈。
   • 记录当前末端位姿作为 接触基准点 Ptouch。
3. 回退生成站位点 沿接触点法向（由力传感器方向或关节运动反算）回退 5mm，得到 柔性逼近起点 Pstart。
   • 这个 Pstart 就是我们需要的、距离釉面精确 5mm 的点。
4. 转入正常清洁逼近 从 Pstart 开始，无缝衔接之前设计的： Fdes=0 + 速度前馈的柔性逼近 → 接触检测 → 切 Fdes=3N恒力清洁。

三、为什么这个方案可靠？

• 绝对安全：0.3N 的探测力，加上过阻尼导纳和柔性小俯仰关节，触碰比手指轻。釉面毫无风险。
• 不依赖视觉：用“触觉”直接感知，无需建模，无遮挡问题。
• 自动适应不同：无论曲面如何，探测总会找到真实釉面，回退距离绝对准。
• 速度快：整个探测运动距离不过几十毫米，5mm/s 速度下耗时不到 2 秒。加上底盘粗定位，整个过程可控制在 3~5 秒内。
• 可重复：每次进入新清洁区，可快速“探—退—开始”。
• 探测方向：初始粗定位后，探测速度方向可以设为末端工具坐标系的-Z轴（大致朝向釉面）。即使方向不是完美法向，轻微侧滑也会被柔顺关节吸收。
• 关节分工：探测运动只驱动小行程俯仰关节（高带宽、低惯量），大俯仰和SCARA保持静止。这样接触瞬间吸收更好，回退也精确。
• 多次探测：若清洁一个需切换多个区域（如从内壁换到座圈），可在每个区域入口执行一次快速探测，更新该区的 Pstart，成本极低。

扩展：若需要完全“非接触”的测量

如果坚持不能有任何物理接触，可在工具模组侧方增加一个微型激光测距传感器（如 VL53L5CX，量程 1~40mm，采样速率 60Hz，视场角可编程，且体积小，防水雾设计）。它可以直接在 10mm 以内给出高精度距离值，让你直接减速并停在 5mm 处，无需接触。

但考虑到内部水雾、泡沫和曲面倾角，光学传感器可能出现跳变。此时，力觉探测可作为冗余安全手段——即使光学失效，力觉仍可无损伤停机并修正。

总结

在视觉和先验模型都不可靠的限制下，最工程化的解决方案是“以柔克刚”：把清洁模组本身变成一个高敏触觉探针，配合底盘粗定位，通过一次超轻接触来“教会”机器人釉面在哪里。这完美利用了导纳控制和小行程俯仰柔性关节，无需增加任何硬件，且绝对安全。

这套方法叫做 “触觉自定位”，也是当前先进制造、医疗器械和清洁机器人中处理不确定环境的经典范式。有了它，就不必纠结于看到或算准，而是让机器人自己“摸”出准确位置。