3. 传感器与检测原理:碰撞检测常用传感器的工作原理与选型
机器人异常保护的第一道防线,是准确、及时地感知“碰撞”这一物理事件。无论是工业机械臂在高速运动时与工装夹具的意外接触,还是服务机器人在人流中与行人的轻微触碰,碰撞检测的实时性与可靠性直接决定了保护动作(如急停、反向退让)能否正确触发。本章将深入剖析三种主流碰撞检测方案——碰撞开关、力传感器和电流检测——的工作原理、工程特性与选型逻辑,帮助你在设计机器人安全系统时建立清晰的判断框架。
3.1 碰撞开关:最直接的通断信号
碰撞开关(又称碰撞传感器、微动开关或限位开关)是原理最简单、成本最低廉的碰撞检测方案。其核心是一个机械触点结构:当机器人外壳或缓冲器受到外力挤压时,传动机构推动内部簧片,使常开触点闭合或常闭触点断开,从而输出一个离散的电平跳变信号。
核心原理与结构
典型的碰撞开关由执行机构(滚轮、杠杆或顶杆)、弹簧复位机构和电气触点组成。在无碰撞状态下,触点保持默认状态(常开或常闭);当碰撞力超过弹簧预紧力时,触点状态翻转。这个“翻转”过程是瞬时的,不依赖外部供电维持,因此具有极高的可靠性——即使控制器死机,开关本身的机械状态变化依然能被安全回路捕获。
判断方法与信号处理
碰撞开关的输出是干接点信号,控制器通过数字输入端口读取。由于机械触点在闭合瞬间会产生抖动(通常持续 5~20ms),软件中必须进行去抖处理。常用的去抖策略包括:
- 硬件去抖:在信号线上并联 RC 低通滤波器(如 10kΩ + 100nF,时间常数约 1ms)。
- 软件去抖:连续采样 N 次(如 10 次,间隔 2ms),若状态一致才确认有效。
- 边沿触发:使用中断方式捕获下降沿/上升沿,配合定时器确认。
选型对比与局限
| 参数维度 | 碰撞开关 | 力传感器 | 电流检测 |
|---|---|---|---|
| 输出信号 | 离散开关量 | 模拟电压/数字总线 | 模拟电流/数字总线 |
| 响应时间 | <1ms(机械) | 1~5ms(含采样) | 5~20ms(含滤波) |
| 检测维度 | 仅“有/无” | 力的大小与方向 | 间接扭矩估算 |
| 安装位置 | 外壳边缘/缓冲器 | 关节/末端执行器 | 电机驱动器内部 |
| 成本(单点) | 5~50元 | 2000~50000元 | 几乎为零(复用驱动) |
| 抗电磁干扰 | 极强 | 需屏蔽与滤波 | 受PWM噪声影响 |
3.2 力传感器:感知碰撞的方向与大小
当机器人需要区分“轻微触碰”与“猛烈撞击”,或者需要感知碰撞发生的具体方位时,碰撞开关就力不从心了。此时需要引入力传感器——它能够将机械力转换为可测量的电信号,为安全控制器提供更丰富的决策依据。
工作原理与类型
机器人领域常用的力传感器主要基于两种物理效应:
- 应变片式:在弹性体(如铝合金或不锈钢)上粘贴电阻应变片,受力时弹性体形变导致应变片电阻变化,通过惠斯通电桥转换为电压信号。这种方案精度高、技术成熟,是关节力矩传感器的主流方案。
- 压电式:利用石英或压电陶瓷的压电效应,受力时产生电荷。其动态响应极快,适合检测高频冲击,但不适合测量静态力(电荷会泄漏)。
在碰撞检测场景中,更常用的是六维力/力矩传感器,它能够同时输出 Fx、Fy、Fz 三个方向的力和 Mx、My、Mz 三个方向的力矩。控制器通过计算合力矢量的大小和方向,可以判断碰撞来自哪个方位,从而执行“反向退让”等精细保护动作。
信号处理与阈值设定
力传感器的原始信号需要经过放大、滤波和标定才能用于碰撞判断。工程实践中,通常采用以下流程:
原始电压 → 仪表放大器 → 低通滤波(截止频率50~200Hz) → ADC采样(1kHz) → 数字滤波(滑动平均) → 力值计算(N) → 阈值比较
阈值设定不能简单取一个固定值,而应考虑机器人的动态载荷。例如,一个 6kg 有效负载的协作机器人,在高速运动时末端惯性力可能达到 30N,若碰撞阈值设为 20N 就会频繁误触发。正确的做法是建立动态阈值模型:
3.3 电流检测:无额外硬件的间接方案
电流检测是一种“不增加任何传感器硬件”的碰撞检测方案。其原理基于电机电枢电流与输出扭矩的近似线性关系:当机器人发生碰撞时,关节电机需要输出更大的扭矩来抵抗碰撞力,导致电流上升。通过监测伺服驱动器中的母线电流或相电流,即可间接推断碰撞事件。
工作原理与数学模型
对于永磁同步电机(PMSM),电磁扭矩 Te 与 q 轴电流 iq 的关系为:
Te = 1.5 × p × ψf × iq
其中 p 为极对数,ψf 为永磁体磁链。在驱动器内部,电流环的给定值或实际反馈值可以直接从寄存器中读取,无需额外布线。当碰撞导致电机堵转或负载突增时,电流环会迅速增大 iq 以维持速度,这一变化可在 1~2 个电流环周期(通常 0.1~0.5ms)内被捕获。
判断方法与工程挑战
电流检测的核心挑战在于区分“碰撞电流”与“正常加速电流”。机器人正常加减速时,电流同样会大幅波动。常用的判别策略包括:
- 斜率检测:碰撞引起的电流变化率(di/dt)远大于正常加速。设定一个较高的变化率阈值,可有效滤除正常操作。
- 速度偏差融合:同时监测电机实际速度与指令速度。若速度偏差超过设定值且电流同时增大,则判定为碰撞。
- 多轴协同判断:单轴电流异常可能是正常负载波动,但若多个关节同时出现电流尖峰,则大概率是整机碰撞。
3.4 实战案例:协作机器人碰撞检测方案设计
下面通过一个完整的工程案例,展示如何将三种传感器组合使用,构建分级碰撞保护系统。
项目背景与约束
某 3C 电子装配线引入 6 轴协作机器人(额定负载 5kg),用于 PCB 板螺丝锁付。现场约束条件如下:
- 机器人工作区域内偶尔有操作员进入(非全封闭围栏),要求碰撞检测响应时间 ≤ 50ms。
- 螺丝锁付过程本身存在 10~20N 的反作用力波动,不能误触发保护。
- 预算有限,无法为每个关节配置高精度力矩传感器。
方案设计与参数配置
最终采用“电流检测为主 + 碰撞开关为辅”的分级方案:
| 保护层级 | 传感器 | 阈值设定 | 响应动作 |
|---|---|---|---|
| 一级(轻微碰撞) | 关节电流检测 | 电流偏差 > 30% 且持续 20ms | 减速至 10% 速度,继续运行 |
| 二级(中等碰撞) | 关节电流检测 | 电流偏差 > 60% 且持续 10ms | 停止运动,保持位置 |
| 三级(严重碰撞) | 碰撞开关(底座+末端) | 开关触发 | 立即急停,切断伺服使能 |
调试过程与结果
初始调试时,一级阈值设为 30% 导致频繁误触发——螺丝锁付瞬间的冲击电流达到了正常值的 1.5 倍。分析后发现,锁付过程电流尖峰持续约 5ms,而碰撞电流通常持续 20ms 以上。因此将一级判断条件改为“电流偏差 > 30% 且持续 15ms”,同时增加二阶低通滤波(截止频率 100Hz),有效滤除了 5ms 的瞬态尖峰。调整后,系统在连续 1000 次锁付测试中零误触发,同时人为碰撞测试 50 次,全部在 30ms 内完成保护动作。
3.5 常见误区与选型总结
在碰撞检测传感器的选型与使用中,工程师常陷入以下误区:
- 误区一:追求单一传感器“万能”。碰撞开关无法感知方向,力传感器成本高昂,电流检测存在减速器盲区。正确思路是分层组合,用不同传感器覆盖不同碰撞场景。
- 误区二:忽略机械结构对传感器的影响。碰撞开关的安装位置、力传感器的预紧力矩、电流检测的减速比,都会显著影响检测效果。例如,将碰撞开关安装在刚性支架上而非弹性缓冲器上,会导致冲击力无法有效传递到开关触点。
- 误区三:阈值设定“一劳永逸”。机器人负载变化、工具更换、环境温度变化都会影响传感器基线。建议在控制系统中加入自动标定流程,每次更换工具或负载后重新学习基线值。
- 误区四:忽视安全完整性等级(SIL)。对于需要达到 SIL2 或 SIL3 的应用,碰撞开关必须采用“双通道冗余 + 诊断覆盖”设计,单一开关的失效可能导致安全功能丧失。
总结而言,碰撞检测传感器的选型应遵循“场景驱动、分层防护、冗余互补”的原则。碰撞开关提供最底层的硬安全回路,力传感器提供精细的碰撞力矢量信息,电流检测则以零成本覆盖大部分碰撞场景。三者结合,才能构建一个既灵敏又可靠、既经济又安全的机器人碰撞保护系统。在实际工程中,务必通过充分的现场测试验证阈值参数,并建立持续监控和调优机制,确保保护功能在整个机器人生命周期内始终有效。