187、运动控制中的行业应用：机械臂力控打磨

运动控制中的行业应用：机械臂力控打磨

一、从一次现场“炸机”说起

去年在佛山某五金抛光厂调试，客户要求用六轴机器人打磨水龙头把手的不规则曲面。按常规位置控制跑轨迹，第一遍空跑看着还行，一上接触力——机器人直接“原地抽搐”，末端工具在工件表面弹跳，打磨出来的表面像被狗啃过。更惨的是，有一次力传感器信号线被冷却液泡了，机器人突然“发疯”往工件里怼，直接把砂带机支架干弯了。

那次之后我明白一个道理：力控打磨不是“位置控制+力传感器”的简单叠加，而是一个涉及动力学、接触稳定性、信号处理的系统工程。今天这篇笔记，就聊聊机械臂力控打磨那些踩过的坑和填坑的方法。

二、力控打磨的核心矛盾：位置刚性与力柔顺

传统工业机器人本质上是位置控制设备——你给一个关节角度指令，伺服驱动器就拼命往那个位置跑，误差越小越好。但打磨作业恰恰相反：你需要工具以恒定压力贴合曲面，而不是死磕某个空间坐标。

这里有个关键概念叫自然约束和人工约束。在打磨场景下，工件表面法线方向是“力约束”——你控制的是接触力大小；切平面方向是“位置约束”——你需要沿着轨迹走。如果搞反了，比如在法线方向硬控位置，遇到工件尺寸偏差或装夹误差，要么压不紧（力太小），要么顶坏工件或机器人（力太大）。

别这样写代码：

// 错误示范：直接位置控制去压工件target_pos<