机械臂曲面跟踪纯工程化方案

索旭东

发布于 2026-02-04 14:51:23

700

文章被收录于专栏：具身小站具身小站

在算法能力有限的情况下，用“分段作业+人机协作”的思路替代复杂的全自动轨迹跟踪。

实施“示教-复现-力控”三段式作业 放弃一开始就依赖有误差的点云进行复杂轨迹规划，改为：
- 阶段一（人工示教）：对于一款新曲面，手动遥控机械臂，借助上述被动柔顺机构，缓慢、安全地完成一次贴合运动。系统记录下这一条关节空间或末端笛卡尔空间的轨迹。
- 阶段二（轨迹回放）：之后对该曲面作业时，机械臂自动复现这条记录轨迹。由于有被动柔顺机构，即使因标定误差有少量位置偏差，也不会硬性碰撞。
- 阶段三（力控维持）：在复现轨迹的同时，启用最基础的恒力控制。利用你的一维压力传感器，在工具法线方向上，根据压力反馈微调末端位置，维持恒定的贴合压力。这比完整的阻抗/导纳控制简单很多。
视觉定位减小初始误差 如果初始误差太大（比如超过10cm），连示教都困难，可增加一个快速视觉补偿步骤：
- 怎么做：在机械臂移动到带误差的位置后，用末端相机拍摄一张曲面边缘的局部特征照片（如曲面边缘），与提前拍摄的模板图进行对比，计算出当前的像素级位置偏差。
- 核心原理：这避开了复杂的三维点云全局匹配，变成了二维图像模板匹配问题，利用OpenCV等开源库，几行代码即可实现，算法门槛极低，能有效将初始误差从10cm降低到1cm以内。

3. 示教回放一致性的关键点

a. 记录并回放关节空间数据

核心原理：机械臂的正运动学计算（从关节值算末端位置）存在累积误差。直接记录并回放关节角度/位置，可以绕过这部分计算误差，是精度最高的方式。
具体操作：示教系统后台，应直接记录电机编码器的原始关节值。复现时，直接将这个关节值序列发送给底层伺服驱动器执行。

b. 复现时关闭或分离外部补偿

问题：复现时，如果视觉伺服或基于模型的误差补偿仍在强力运行，会试图“纠正”示教轨迹，反而引入干扰。
解决：复现阶段，暂时屏蔽所有基于外部传感器（如视觉）的在线轨迹修正，让机械臂纯净地执行记录的关节轨迹。力控环路保持开启，但仅做垂直于曲面方向（法向方向）的微调，不影响轨迹主线。

c. 回放不一致的故障排查内容

排查环节	可能原因与排查方法	解决措施
数据记录	错误地记录了末端笛卡尔位姿（x,y,z），而非关节值。检查：查看示教保存的数据文件格式。	修改示教程序，直接读取并存储各关节电机编码器值。
数据传输/解析	回放时，上位机对存储的关节数据进行了不必要的二次插值或轨迹规划，改变了原始点序列。检查：在回放模式下，对比发送给驱动器的实时指令值与存储的原始值是否一致。	确保回放路径是最短、最直接的，避免任何中间处理模块。采用点对点位置模式直接发送关节目标值。
伺服执行	1. 伺服增益不一致：示教时可能处于“柔顺”的低增益模式，复现时是高增益模式，导致动态误差不同。2. 未屏蔽外部补偿：监控复现时伺服电机的实际位置与指令位置偏差是否过大。	1. 确保示教与复现处于相同的伺服控制模式与参数组。2. 在回放轨迹时，临时屏蔽所有在线标定补偿和视觉伺服。
机械状态	关节背隙或皮带/丝杠张紧度在示教与复现间发生变化。检查：进行重复定位精度测试（多次往返同一关节点，看末端位置变化）。	进行机械调整（如调整皮带张紧）或进行背隙补偿（在控制软件中设置）。