📚 课程目录第3章力控技术基础

三、力控技术基础：力/力矩传感器原理、力控系统组成、力觉反馈在机器人中的应用

力控拖动示教系统的核心在于“感知力”与“响应力”。在工业机器人领域，传统的位控模式（位置控制）假设环境是刚性的，机器人严格按照预设轨迹运动；然而在打磨、装配、抛光和拖动示教等场景中，机器人末端与环境的接触力必须被实时感知并主动调节，否则极易产生碰撞过载或接触不良。本章作为从入门到实战的第三课，将系统梳理力/力矩传感器的物理原理、力控系统的硬件与软件组成，以及力觉反馈在机器人应用中的典型模式。理解这些基础概念，是后续设计拖动示教算法、标定重力矩、辨识摩擦力的前提。

3.1 力/力矩传感器的工作原理与选型要点

3.1.1 核心原理：从应变到六维力

工业机器人末端使用的力/力矩传感器，绝大多数基于电阻应变式原理。其核心结构是一个弹性体（通常为铝合金或不锈钢），在弹性体的特定位置粘贴电阻应变片，并组成惠斯通电桥。当外力作用于传感器时，弹性体发生微米级形变，应变片电阻值随之变化，电桥输出电压与应变（即外力）成正比。通过精心设计弹性体的结构（如十字梁、双环形、三梁结构），可以解耦出六个分量：三个力分量（Fx, Fy, Fz）和三个力矩分量（Mx, My, Mz）。

除了应变式，还有压电式（适合动态力测量，不适合静态保持）和电容式（高灵敏度但温漂较大）传感器。在拖动示教场景中，由于需要检测操作者施加的持续力（包括静态保持），应变式传感器是主流。

类型	精度	刚度	动态响应	温漂	拖动示教适用性
应变式	0.1% FS	高	良好	中等（需补偿）	★★★★★
压电式	0.5% FS	极高	极快	低	★★（不适合静态力）
电容式	0.05% FS	低	中等	高	★★★

3.1.2 关键性能指标与选型判断

选型时不能只看量程，必须关注以下五个维度：

过载保护：拖动示教过程中可能出现意外冲击，传感器过载能力至少应为额定量的 3-5 倍。
串扰（Cross-talk）：指某一方向受力时对其他方向输出的影响，优质传感器串扰应小于 1% FS。
采样率与带宽：力控系统要求传感器输出频率 ≥ 1kHz，力控环带宽通常为 5-20Hz，传感器带宽应至少为力控带宽的 10 倍。
分辨率与噪声：拖动示教要求分辨率达到 0.1N 级别，否则操作者会感到“颗粒感”。
温度稳定性：传感器内部需有温度补偿电阻，否则机器人运行 30 分钟后温漂会导致零力偏移。

经验提醒：在拖动示教项目中，不要盲目追求高精度（如 0.02% FS）的传感器，因为机器人本体的摩擦力和重力矩补偿误差通常在 1-2N 级别，传感器精度过高反而会放大机械振动噪声。选择 0.1% FS、量程为额定负载 1.5-2 倍的传感器是性价比最高的方案。

3.2 力控系统的组成架构

3.2.1 硬件组成：从传感器到执行器的信号链

一套完整的力控系统由五个硬件层级构成：

感知层：六维力/力矩传感器（安装于机器人法兰与末端工具之间）。
调理层：信号放大器、抗混叠滤波器、ADC 采样电路。应变式传感器输出差分毫伏级信号，必须经过仪表放大器放大至 ±10V 或 4-20mA 标准信号。
传输层：工业现场总线（EtherCAT、CANopen、Profinet）或模拟量传输。数字传输抗干扰能力强，推荐 EtherCAT，周期可达 1ms 以内。
计算层：机器人控制器（或外部工控机）中的力控算法模块，运行阻抗/导纳控制律。
执行层：伺服驱动器与电机，接收力矩/位置指令并产生实际运动。

3.2.2 软件架构：力控环与位置环的嵌套关系

力控系统在软件上通常采用外环力控、内环位控的嵌套结构。外环以 1kHz 频率读取六维力数据，经过重力/摩擦力补偿后，通过导纳控制律计算机器人末端的期望位置修正量；内环（通常 4-8kHz）执行位置伺服控制。这种结构的优势在于可以复用机器人原有的高性能位置环，同时通过修改外环参数即可调整拖动柔顺性。

// 导纳控制核心伪代码（1kHz 循环）
while (loop_active) {
    F_sensor = read_ft_sensor();           // 读取六维力
    F_ext = F_sensor - F_gravity - F_friction; // 补偿重力与摩擦力
    X_dot = F_ext / B_damping;             // 导纳关系：力→速度
    X_ref += X_dot * dt;                   // 积分得到位置修正
    robot_servo_set_position(X_ref);       // 下发位置指令
}

3.2.3 力控系统组成对比表

层级	关键器件	典型参数	故障影响
感知层	六维力传感器	量程 200N/20Nm	数据跳变、零漂
调理层	仪表放大器、ADC	24bit, 1kHz	噪声增大、信号饱和
传输层	EtherCAT 从站	周期 1ms	通信超时、丢帧
计算层	实时控制器	1kHz 控制周期	控制发散、抖动
执行层	伺服驱动器	电流环 5kHz	跟踪延迟、振动

3.3 力觉反馈在机器人中的典型应用模式

3.3.1 四种基本力控模式

力觉反馈在机器人中的应用可以归纳为四种基本模式，拖动示教属于其中的“零力/导纳控制”模式：

力跟随（Force Tracking）：机器人末端沿某一方向施加恒定力，如打磨、抛光。力控环根据力误差调整位置，使接触力恒定在设定值。
阻抗/导纳控制（Impedance/Admittance）：建立力与位置/速度的动态关系（质量-阻尼-弹簧模型），使机器人表现出期望的柔顺特性。拖动示教即导纳控制的典型应用——操作者施加力，机器人以相应速度跟随。
力/位混合控制（Hybrid Force/Position）：在某些自由度上控制力，在另一些自由度上控制位置，适用于轴孔装配等约束运动。
碰撞检测与安全响应：通过监测关节力矩或末端力，当检测到超过阈值的冲击力时，机器人立即停止或回退，保障人机协作安全。

3.3.2 拖动示教中的力觉反馈闭环

在拖动示教场景中，力觉反馈的作用并非“控制力的大小”，而是消除机器人本体的重力、摩擦力和惯性力，使操作者感觉像是在拖动一个无重力的漂浮物体。具体实现包括：

重力矩补偿：根据机器人当前关节角，通过动力学模型计算各连杆产生的重力矩，从传感器读数中减去。
摩擦力补偿：建立关节速度与摩擦力的映射模型（库仑摩擦+粘性摩擦），在控制指令中前馈补偿。
惯性补偿：当操作者快速拖动时，机器人本体的惯性力会阻碍运动，需要通过加速度前馈进行补偿。

  案例拆解：六轴机器人拖动示教系统的力觉调试

  背景与约束：某 3C 产线需要机器人完成 PCB 板抓取路径的现场示教，负载 3kg，要求拖动力小于 5N，且不能产生明显振动。机器人控制器为倍福 TwinCAT，传感器为 ATI Axia80。

  初始现象：直接启用厂商提供的“零力模式”后，操作者感觉机器人“很沉”，在低速拖动时明显有顿挫感，且停止后末端有 2-3mm 的位置回弹。

  分析过程：通过日志发现，传感器读数在静止时存在 8N 的重力分量未完全补偿（因为工具重心标定不准）；低速时摩擦力补偿值偏小，导致启动阻力大；回弹则是导纳控制阻尼参数 B 设置过小（B=50 N·s/m），系统欠阻尼。

  操作步骤：① 重新进行工具重心标定，将 TCP 重量和重心位置误差控制在 0.5mm 以内；② 在关节空间增加 Stribeck 摩擦模型，补偿低速区的非线性摩擦；③ 将导纳阻尼从 50 调至 150 N·s/m，刚度 K 设为 0（纯速度导纳）；④ 在力信号入口增加 10Hz 二阶巴特沃斯低通滤波器，抑制高频噪声。

  结果对比：调试后拖动力从 12N 降至 3.5N，停止回弹小于 0.5mm，操作者主观评价“顺滑、轻盈”。

  风险与代价：增大阻尼后，高速拖动时会有“粘滞感”，需要根据操作者习惯设置多档阻尼切换。

3.3.3 力觉反馈应用模式对比

应用模式	控制目标	传感器安装位置	典型行业	拖动示教关联度
力跟随	接触力恒定	末端法兰	打磨、去毛刺	低
导纳控制	力→速度响应	末端法兰	拖动示教、装配	高（核心）
力/位混合	分自由度控制	末端法兰	轴孔装配、插拔	中
碰撞检测	安全保护	关节力矩/末端	人机协作	中（安全冗余）

3.4 常见误区与设计复盘

3.4.1 误区一：传感器精度越高越好

在拖动示教中，系统整体性能受限于机器人本体的动力学模型精度。如果重力补偿误差为 2N，即使传感器分辨率达到 0.01N，操作者感受到的“残余力”仍然是 2N。过度追求传感器精度不仅增加成本，还可能引入更多高频噪声。正确的做法是：传感器精度与机器人动力学补偿精度匹配即可。

3.4.2 误区二：忽略传感器安装刚度

传感器与机器人法兰、末端工具之间的连接必须采用高强度螺栓并施加规定扭矩。若连接刚度不足，在拖动过程中会产生微小的相对位移，导致力信号出现滞后和振荡。此外，传感器线缆必须固定良好，避免线缆拖拽产生额外力。

3.4.3 误区三：力控周期与位置环周期不匹配

力控外环周期（通常 1-2ms）必须慢于位置内环周期（通常 0.25-0.5ms），否则会造成控制指令“饥饿”。同时，力信号的低通滤波截止频率应低于力控环 Nyquist 频率的一半，否则会引起极限环振荡。

风险提示：在拖动示教系统调试初期，务必设置力/力矩软限位和机器人关节速度限位。一旦重力补偿参数设置错误（如工具重量输入为 0），机器人会在重力作用下加速坠落，可能造成人员伤害或设备损坏。建议先在低速模式（如 10% 速度）下验证补偿效果，再逐步提高拖动速度。

3.4.4 设计复盘清单

是否对传感器进行了温度补偿和上电预热（建议预热 10 分钟）？
工具重心标定是否精确到 1mm 以内？
摩擦力模型是否覆盖了低速区（Stribeck 效应）？
导纳控制参数（阻尼 B、惯量 M）是否根据操作者习惯进行了多档位设计？
是否在急停回路中并联了力传感器超限信号？