当前位置:首页 > 中国芯 > 具身智能
[导读]导读:六维力传感器(Six-Axis Force/Torque Sensor,F/T 传感器)在 1.5 g 的搬运加速度下,读数里有近九成是工具的重力与惯性力,真正要闭环的接触力只剩 8 N。补偿的难点不在标定精度,在加速度从哪里取。

六维力传感器(Six-Axis Force/Torque Sensor,F/T 传感器)在 1.5 g 的搬运加速度下,读数里有近九成是工具的重力与惯性力,真正要闭环的接触力只剩 8 N。补偿的难点不在标定精度,在加速度从哪里取。

一句话答案 传感器测的是合力,2.5 kg 工具在 15 m/s² 下产生 37.5 N 惯性力,是接触力的 4.7 倍。

传感器测的是合力,不是接触力

六维力传感器是指能同时测量三个方向力与三个方向力矩的应变式传感器,输出的是法兰坐标系下的合力与合力矩,不区分来源。

工程上要的接触力只是其中一项。完整分解写成 F测 = F接触 + m(g − a) + F线缆 + F串扰,前三项里的加速度项在快速运动时最大,线缆项在关节大角度时最大。

线缆项最容易被忽略。传感器出线从法兰走到第六轴,大角度回转时线束被拉紧,产生 2 N 到 5 N 的随机力,方向随姿态变化,标定时静置的零点扣不掉它。走线留一段松弛弯,或者用扁平排线贴着臂体走,这一项能压到 0.5 N 以下。

定义清楚之后,很多现场问题就顺了。装配工位上报“力传感器零点漂了”,实际是质心坐标填错,工具换过一次没有重新标,惯性力矩按旧质心算,差出 0.6 N·m。

1.5 g 的搬运里,惯性项占九成

按公开参数测算:工具加夹爪 2.5 kg,质心距法兰 120 mm,搬运加速度 15 m/s²,接触力 8 N。三项同向叠加时读数 70 N,其中惯性项 37.5 N,重力项 24.5 N,接触力只占 11%。

图 1 法兰坐标系下的三项力分解(自行绘制,为原理示意,非原文原图复制)

传感器本身的分辨率在这里不是瓶颈。200 N 量程配 24 位 ADC,分辨率能到 0.05 N,远小于 0.4 N 的误差预算,真正的瓶颈是把 37.5 N 的惯性项算准。

这个比值决定了补偿的精度要求。想把 8 N 的接触力测到 ±5%,总误差必须压在 0.4 N 以内,相当于对 37.5 N 的惯性项做 1% 的补偿,而传感器本身的串扰就有 1% FSO,量程 200 N 下是 2 N。

惯性力矩同样要算。4.5 N·m 的惯性力矩作用在 120 mm 力臂上,折算成等效力是 37.5 N,与惯性力本身同量级,只补力不补力矩等于没补。

质心标定的误差在力矩项上放大最快。质心偏 5 mm,15 m/s² 下力矩误差 0.19 N·m,折算到 120 mm 力臂是 1.6 N,等于把接触力算错 20%。工具每换一次夹具,质心就要重新标一次。

加速度从哪来,这才是难点

加速度最省事的来源是关节编码器二次差分,代价是噪声被放大 (2πf)²。19 位编码器在 1 kHz 采样下的位置噪声约 0.001°,二次差分后加速度噪声到 2 m/s²,乘 2.5 kg 就是 5 N,比接触力还大。

所以必须滤波。一阶低通取 30 Hz,时间常数 5.3 ms,加速度噪声降到 0.5 m/s²,对应补偿残差 1.25 N。滤波器在 20 Hz 处再贡献 34° 相位滞后,力控环路的相位裕度从 45° 掉到 26°,环路增益必须往下压。

时间同步是第三个来源。相机 30 fps、力控 1 kHz、IMU 200 Hz,三路数据进控制器时如果各用各的时钟,融合后的加速度会滞后一拍 5 ms,等于又引入 0.75 N 的误差。用同一个分布式时钟打时间戳,这一项才能消掉。

按公开参数测算补偿残差:残余 = m · δa + δm · a = 2.5 × 0.5 + 0.025 × 15 = 1.6 N。第二项来自工具质量 1% 的估计误差,在 15 m/s² 下就贡献 0.375 N,这一项靠滤波压不下去,只能靠称重。

补偿方案
卸载后残余误差(N,1.5 g)
力控可用带宽(Hz)
附加延迟(ms)
8 N 接触力下的误差占比
判定
不补偿
62.0
10
0
775%
不可用
只扣重力
37.5
10
0
469%
不可用
重力 + 质心
6.8
30
3.5
85%
仅准静态可用
加编码器差分加速度
1.6
40
5.3
20%
可闭环,定位精度 0.2 mm 级
加 IMU 融合
1.2
55
8.0
15%
首选,需刚性安装
再加温度零点跟踪
0.4
45
12
5%
精密插装专用

表注:残余误差口径为 2.5 kg 工具、15 m/s²、8 N 接触力下的合力偏差;带宽按相位滞后 45° 折算;延迟含采样与滤波。

图 2 末端加速度对残余误差的放大(自行绘制,据公开参数重绘,非原文原图复制)

串扰与温漂是第二层误差

串扰在动态下会被放大。1% FSO 的串扰在静态标定时可以扣掉,动态下因为六路应变桥的响应时间不一致,扣不干净,残余约 0.3 N。

截至 2026 年 10 月,国产六维力传感器的串扰指标普遍标到 1% FSO,进口件标 0.5%,两者在 1.5 g 下的差别是 1 N 与 0.5 N。

温漂更麻烦。应变片的零点温度系数在 0.05% FSO/°C 量级,机柜内温升 10 °C 就带来 1 N 的零点偏移,与 8 N 的接触力相比是 12%。开机后前二十分钟的漂移最快,这段时间做精密插装最不可靠。

失效场景按机理推演:产线节拍紧,机器人在上电 5 分钟后开始插装,传感器零点还没稳定,控制器把 1.5 N 的漂移当成接触力,提前 0.3 mm 判定到位,连接器只插进去一半。处置是开机预热 20 分钟再进生产,或在工位上加一次空载回零。两条都做的成本最低,预热让零点漂移进入平缓段,空载回零把残余偏置直接清掉,代价是每个节拍多 0.4 s。

标定解决不了动态误差

行业通行说法是六维力传感器的精度取决于标定与串扰补偿,把标定做细就能测准。这个说法在准静态场合成立,在快速搬运场合不成立。标定能扣掉的是偏置、串扰、质心与安装倾角这四项常数项,全是与加速度无关的量。1.5 g 下主导误差的 m·a 项随轨迹变化,标定表里没有这一项,只能实时算。把标定精度从 1% 提到 0.2%,总误差从 1.6 N 只降到 1.4 N,因为 1.25 N 那一项根本没动。还有一个可以量化的旁证:把同一条轨迹的速度降一半,加速度从 15 m/s² 降到 4 m/s²,惯性项从 37.5 N 降到 10 N,残余误差跟着从 1.6 N 降到 0.6 N,力控就稳了,代价是节拍翻倍。

这条判断的边界是加速度 2 m/s²。低于这个数,惯性项小于 5 N,标定与串扰才是瓶颈;高于 5 m/s²,无论标定做得多好,不做加速度补偿的误差占比都在 400% 以上。

选型:连接器插装走一遍

按以下约束走一遍选型:末端负载 2.5 kg、插装接触力 8 N、允许力误差 ±0.5 N、节拍要求单次插装 0.8 s、加速度峰值 15 m/s²、传感器预算不超过 3 万元、控制器环路 1 kHz。

候选三个:200 N 量程的应变式六维力传感器配编码器差分补偿、同款配 IMU 融合补偿、100 N 量程的紧凑型配 IMU 融合。

逐项对比见表。三个候选的分辨率都在 0.05 N 以下,差别不在分辨率,在串扰绝对值与过载余量。200 N 量程的过载余量 5 倍,碰到夹具撞件不会坏,但串扰 2 N 让 ±0.5 N 的预算从一开始就不成立。200 N 量程的分辨率够,但串扰 1% FSO 就是 2 N,超过 0.5 N 的误差预算,必须靠软件补偿压到 1.6 N 或 1.2 N。100 N 量程把串扰绝对值压到 1 N,代价是过载能力只剩 2 倍,插装时的侧向冲击容易打满量程。

选定 100 N 量程加 IMU 融合,理由是串扰绝对值 1 N、IMU 在 200 Hz 下给出的加速度误差 0.3 m/s²,残余误差 0.8 N,配合 ±0.5 N 的判定门限可以留 0.3 N 余量,0.8 s 节拍下实测残余 0.9 N。

放弃 200 N 量程的理由还有一条,软件的补偿只在误差项上有效,串扰的绝对值没法靠滤波压下去。100 N 量程把 1% FSO 从 2 N 降到 1 N,同样一套补偿算法在这个底数下把残余做到 0.8 N,200 N 量程只能做到 1.6 N。

这一套配置的装配要求也变了。传感器与 IMU 的坐标要统一到同一个法兰坐标系,两者之间差 0.5 mm 就会在 15 m/s² 下多出 0.3 N 的残差,标定的时候要把两个坐标系一起标。

代价与风险:IMU 必须刚性安装在法兰上,用弹性支架会让相位滞后多 3 ms;100 N 量程的过载余量只有 2 倍,碰撞检测的门限要从 60 N 降到 45 N,误触发率上升;IMU 与编码器的时间戳要对齐到 1 ms 以内,否则融合出来的加速度会有台阶。

如果末端加速度超过 5 m/s² 且接触力小于 10 N,就必须做加速度补偿,只做重力补偿的残余误差仍在 400% 以上,代价是 5 ms 延迟、一次 15 分钟的 IMU 标定与 8000 元的传感器差价。

一句话 力传感器给出的永远是合力,接触力要靠减去重力和惯性力算出来,减得准不准取决于加速度测得准不准。

文献依据:Applied Sciences,2025 年,第 15 卷第 3 期,文章号 1510

文献标题:On-Site Implementation of External Wrench Measurement via Non-Linear Optimization in Six-Axis Force–Torque Sensor Calibration and Crosstalk Compensation

作者:Jiyou Shin、Jinjae Shin、Hong-ryul Jung、Jaeseok Won、Eugene Auh、Hyungpil Moon

期刊卷期:Applied Sciences,第 15 卷,第 3 期,文章号 1510,2025 年 2 月

DOI:10.3390/app15031510

第二来源:Robot Manipulation Skills Transfer for Sim-to-Real in Unstructured Environments,Zikang Yin、Chao Ye、Hao An、Weiyang Lin、Zhifeng Wang,Electronics,第 12 卷,第 2 期,文章号 411,2023 年 1 月,DOI 10.3390/electronics12020411

配图说明:图 1、图 2 均为自行绘制,图 1 为原理示意,图 2 据公开参数重绘,非原文原图复制

改动声明:基于开放获取文献的独立解读,标题、结构、行文、表格、案例与配图为原创

来源:21ic电子网

本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除( 邮箱:macysun@21ic.com )。
关闭