力矩反馈基础:力矩传感器的原理与信号调理

各位同学,今天我们来聊聊力矩反馈。说实话,力矩反馈是关节控制里最容易被忽视、却又最关键的一环。我刚开始做机器人时,总觉得只要电机选得好、算法写得妙,关节就能听话。结果呢?有一次调试六轴机械臂,空载时轨迹跑得漂亮,一夹工件就开始抖——后来才发现,是力矩信号太脏,控制器根本读不到真实值。

所以这一章,咱们把力矩传感器从头到尾拆一遍。你想想看,传感器就是控制器的眼睛,眼睛看不清,后面再好的算法也白搭。

2.1 力矩传感器的核心原理

力矩传感器,说白了就是把机械变形或压力变化,转成电信号。目前工业界用得最多的,就两种原理:应变片和压电效应。

2.1.1 应变片原理

应变片的工作原理其实很简单——金属丝被拉长时电阻变大,被压缩时电阻变小。这个现象叫应变电阻效应。

我习惯把应变片想象成一根橡皮筋:你拉它,它变细变长,电阻增加;你压它,它变粗变短,电阻减小。贴在弹性体表面,就能把力矩引起的微小形变,转成电阻变化。

关键公式:

ΔR / R = K × ε

其中 ΔR 是电阻变化量,R 是初始电阻,K 是应变灵敏系数(通常 2.0~2.2),ε 是应变。

说白了,电阻变化率 ≈ 灵敏系数 × 形变程度。

实际应用中,单个应变片的信号太弱,而且受温度影响大。所以工程上常用惠斯通电桥来补偿。

电桥类型 应变片数量 温度补偿 灵敏度 典型应用
1/4 桥 1 个 差 低 教学实验
半桥 2 个 较好 中 简单力传感器
全桥 4 个 优秀 高 工业力矩传感器

我个人建议,做关节力矩检测时,尽量用全桥。虽然成本高一点,但信噪比和温漂表现完全不是一个级别。我曾经在一个协作机器人项目里,为了省钱用了半桥,结果温度一变化,零点漂移比信号还大——后来老老实实换了全桥。

2.1.2 压电效应原理

压电效应就更有意思了。某些晶体(比如石英、压电陶瓷)受到机械应力时,表面会产生电荷。电荷量和受力大小成正比。

你想想看,这就像一块石头被锤子砸了一下,会蹦出火花——当然压电效应没那么夸张,但原理类似:机械能直接转电能。

压电传感器有几个特点,我列出来大家注意:

  • 动态响应极快:能测到 kHz 甚至 MHz 级别的力变化
  • 不能测静态力:电荷会通过电路泄漏,无法维持
  • 输出阻抗极高:信号调理电路必须特殊设计
  • 适合冲击力、振动测量

注意:压电传感器不能用于静态力矩测量!如果你需要检测关节在静止状态下的力矩(比如重力补偿),请用应变片方案。我曾经见过有人把压电传感器用在机器人夹爪的静态夹持力检测上,结果信号每秒钟掉 5%,根本稳不住。

2.2 力矩信号的采集与调理

传感器输出的原始信号,基本没法直接用。为什么?因为信号太微弱、噪声太多、还有各种干扰。我把它比作「在菜市场里听蚊子叫」——你得先过滤掉周围的嘈杂声,再把蚊子叫放大到能听清的程度。

信号调理一般分三步走:

  1. 放大:把 mV 级信号放大到 V 级
  2. 滤波:去除高频噪声和工频干扰
  3. 模数转换:把模拟信号变成数字量,送给控制器

2.2.1 放大电路

应变片电桥的输出通常是几 mV 到几十 mV,需要仪表放大器来放大。我常用的型号是 AD620 或 INA128,共模抑制比高,噪声低。

// 典型仪表放大器增益设置
// AD620 增益公式: G = 49.4kΩ / RG + 1
// 目标增益 500 倍
RG = 49.4kΩ / (500 - 1) ≈ 99Ω

// 实际选型:RG = 100Ω,实际增益 ≈ 495 倍

这里有个坑:增益不是越大越好。增益太高,放大器的偏置电压也会被放大,导致输出饱和。我一般先估算满量程输出,再留 20% 余量。

2.2.2 滤波设计

力矩信号里的噪声主要来自:电机 PWM 开关噪声、机械振动、50Hz 工频干扰。我习惯用二阶巴特沃斯低通滤波器,截止频率设在 100Hz 左右。

为什么是 100Hz?因为关节控制的带宽通常不超过 50Hz,100Hz 既能保留有效信号,又能滤掉大部分噪声。

小技巧:如果发现滤波后信号有相位延迟,可以试试贝塞尔滤波器。它的群延迟更平坦,适合需要实时性的力矩反馈。我在一个力控打磨项目里吃过亏——用巴特沃斯滤波器,相位延迟导致系统振荡,换成贝塞尔就好了。

2.2.3 模数转换

ADC 选型时,分辨率至少 16 位,采样率不低于 1kHz。我推荐用 Σ-Δ 型 ADC,内置数字滤波,抗噪能力强。

参数 最低要求 推荐值 说明
分辨率 12 bit 16~24 bit 12 bit 在低力矩时量化噪声明显
采样率 500 Hz 1~5 kHz 满足奈奎斯特,留余量
输入范围 ±5 V ±10 V 匹配放大器输出

2.3 力矩反馈在闭环控制中的作用

好了,信号采回来了,接下来就是重头戏——力矩反馈怎么用?

传统的关节控制是位置环+速度环,说白了就是「我让你转到哪,你就转到哪」。但机器人要跟环境交互啊,比如装配、打磨、抓取,这时候光有位置控制是不够的。

力矩反馈的作用,我总结成三个字:知轻重。

  • 碰撞检测:力矩突然增大 → 碰到障碍物 → 立即停止或回退
  • 力位混合控制:在某个方向用力矩控制,其他方向用位置控制
  • 阻抗控制:让机器人表现出弹簧阻尼特性,柔顺地与环境互动

我画了一张图,帮大家理解力矩反馈在闭环中的位置:

力矩反馈在关节闭环控制中的位置 目标位置 位置控制器 力矩控制器 电机驱动 关节 力矩传感器 流程说明: 1. 位置控制器输出期望力矩 → 力矩控制器根据反馈调整 → 驱动电机 2. 力矩传感器实时检测关节实际力矩 → 反馈给力矩控制器 3. 形成双闭环:外环位置控制,内环力矩控制

你看这个结构,力矩反馈是内环。内环的响应速度必须比外环快 5~10 倍,否则系统会不稳定。我一般把力矩环的带宽设在 200Hz 以上,位置环 20~40Hz。

2.3.1 实际项目中的避坑经验

最后分享一个我踩过的坑。有一次做力控打磨,力矩反馈一直有 2~3Hz 的振荡。查了三天,最后发现是传感器安装面的刚度不够——关节受力时,安装面本身也在变形,相当于传感器测到的力矩包含了结构变形分量。

解决办法:

  • 增加安装法兰的厚度和刚度
  • 在软件里加一个陷波滤波器,专门滤掉结构共振频率

嗯,这件事之后,我每次设计力矩传感器安装结构,都会先做模态分析,确保安装刚度至少是传感器量程的 10 倍以上。

核心要点回顾:

  • 应变片适合静态/准静态力矩测量,全桥方案最可靠
  • 压电传感器只能测动态力,不能用于静态保持
  • 信号调理三件套:放大→滤波→ADC,缺一不可
  • 力矩反馈作为内环,带宽要远高于位置外环
  • 传感器安装刚度直接影响测量精度,别忽视机械结构