3. 传感器与检测原理:碰撞检测常用传感器的工作原理与选型

机器人异常保护的第一道防线,是准确、及时地感知“碰撞”这一物理事件。无论是工业机械臂在高速运动时与工装夹具的意外接触,还是服务机器人在人流中与行人的轻微触碰,碰撞检测的实时性与可靠性直接决定了保护动作(如急停、反向退让)能否正确触发。本章将深入剖析三种主流碰撞检测方案——碰撞开关、力传感器和电流检测——的工作原理、工程特性与选型逻辑,帮助你在设计机器人安全系统时建立清晰的判断框架。

碰撞检测传感器选型与信号链路 碰撞事件 物理接触/冲击 碰撞开关 离散信号:0/1 力/力矩传感器 模拟量:Fx/Fy/Fz 电机电流检测 间接感知:扭矩变化 安全控制器 阈值判断 滤波/融合 保护动作 急停/退让/报警 选型关键维度 • 响应速度:碰撞开关 < 1ms | 力传感器 1-5ms | 电流检测 5-20ms(含滤波) • 检测精度:碰撞开关仅“有/无” | 力传感器可测方向与大小 | 电流检测为间接估算 • 成本与可靠性:碰撞开关最低 | 力传感器最高 | 电流检测无额外硬件成本

3.1 碰撞开关:最直接的通断信号

碰撞开关(又称碰撞传感器、微动开关或限位开关)是原理最简单、成本最低廉的碰撞检测方案。其核心是一个机械触点结构:当机器人外壳或缓冲器受到外力挤压时,传动机构推动内部簧片,使常开触点闭合或常闭触点断开,从而输出一个离散的电平跳变信号。

核心原理与结构

典型的碰撞开关由执行机构(滚轮、杠杆或顶杆)、弹簧复位机构和电气触点组成。在无碰撞状态下,触点保持默认状态(常开或常闭);当碰撞力超过弹簧预紧力时,触点状态翻转。这个“翻转”过程是瞬时的,不依赖外部供电维持,因此具有极高的可靠性——即使控制器死机,开关本身的机械状态变化依然能被安全回路捕获。

工程要点:碰撞开关的“阈值”由弹簧预紧力决定,而非电子阈值。选型时需关注操作力(OF)和释放力(RF)两个参数。例如,服务机器人前 bumper 通常选用操作力在 0.5N~2N 的轻触型开关,而工业 AGV 则可能需要 5N~10N 的防误触型开关。

判断方法与信号处理

碰撞开关的输出是干接点信号,控制器通过数字输入端口读取。由于机械触点在闭合瞬间会产生抖动(通常持续 5~20ms),软件中必须进行去抖处理。常用的去抖策略包括:

  • 硬件去抖:在信号线上并联 RC 低通滤波器(如 10kΩ + 100nF,时间常数约 1ms)。
  • 软件去抖:连续采样 N 次(如 10 次,间隔 2ms),若状态一致才确认有效。
  • 边沿触发:使用中断方式捕获下降沿/上升沿,配合定时器确认。

选型对比与局限

参数维度碰撞开关力传感器电流检测
输出信号离散开关量模拟电压/数字总线模拟电流/数字总线
响应时间<1ms(机械)1~5ms(含采样)5~20ms(含滤波)
检测维度仅“有/无”力的大小与方向间接扭矩估算
安装位置外壳边缘/缓冲器关节/末端执行器电机驱动器内部
成本(单点)5~50元2000~50000元几乎为零(复用驱动)
抗电磁干扰极强需屏蔽与滤波受PWM噪声影响

3.2 力传感器:感知碰撞的方向与大小

当机器人需要区分“轻微触碰”与“猛烈撞击”,或者需要感知碰撞发生的具体方位时,碰撞开关就力不从心了。此时需要引入力传感器——它能够将机械力转换为可测量的电信号,为安全控制器提供更丰富的决策依据。

工作原理与类型

机器人领域常用的力传感器主要基于两种物理效应:

  1. 应变片式:在弹性体(如铝合金或不锈钢)上粘贴电阻应变片,受力时弹性体形变导致应变片电阻变化,通过惠斯通电桥转换为电压信号。这种方案精度高、技术成熟,是关节力矩传感器的主流方案。
  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)远大于正常加速。设定一个较高的变化率阈值,可有效滤除正常操作。
  • 速度偏差融合:同时监测电机实际速度与指令速度。若速度偏差超过设定值且电流同时增大,则判定为碰撞。
  • 多轴协同判断:单轴电流异常可能是正常负载波动,但若多个关节同时出现电流尖峰,则大概率是整机碰撞。
风险提示:电流检测存在“盲区”——当碰撞发生在机器人末端且力臂较长时,关节电机可能因减速器自锁特性而几乎不产生额外电流。例如,协作机器人在低速状态下被外力推挤末端,减速器反向驱动效率极低,电流变化可能小于 5%,此时电流检测完全失效。因此,电流检测通常作为辅助保护层,而非唯一的安全保障。

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 内完成保护动作。

复盘经验:电流检测的阈值设定不能只看“幅值”,必须结合“持续时间”和“变化率”综合判断。此外,滤波器的引入会带来延迟——100Hz 低通滤波器引入约 3ms 群延迟,在计算总响应时间时必须计入。最终系统总响应时间 = 电流采样周期(1ms) + 滤波延迟(3ms) + 判断逻辑(2ms) + 制动器动作(10ms) ≈ 16ms,满足 50ms 要求。

3.5 常见误区与选型总结

在碰撞检测传感器的选型与使用中,工程师常陷入以下误区:

  • 误区一:追求单一传感器“万能”。碰撞开关无法感知方向,力传感器成本高昂,电流检测存在减速器盲区。正确思路是分层组合,用不同传感器覆盖不同碰撞场景。
  • 误区二:忽略机械结构对传感器的影响。碰撞开关的安装位置、力传感器的预紧力矩、电流检测的减速比,都会显著影响检测效果。例如,将碰撞开关安装在刚性支架上而非弹性缓冲器上,会导致冲击力无法有效传递到开关触点。
  • 误区三:阈值设定“一劳永逸”。机器人负载变化、工具更换、环境温度变化都会影响传感器基线。建议在控制系统中加入自动标定流程,每次更换工具或负载后重新学习基线值。
  • 误区四:忽视安全完整性等级(SIL)。对于需要达到 SIL2 或 SIL3 的应用,碰撞开关必须采用“双通道冗余 + 诊断覆盖”设计,单一开关的失效可能导致安全功能丧失。

总结而言,碰撞检测传感器的选型应遵循“场景驱动、分层防护、冗余互补”的原则。碰撞开关提供最底层的硬安全回路,力传感器提供精细的碰撞力矢量信息,电流检测则以零成本覆盖大部分碰撞场景。三者结合,才能构建一个既灵敏又可靠、既经济又安全的机器人碰撞保护系统。在实际工程中,务必通过充分的现场测试验证阈值参数,并建立持续监控和调优机制,确保保护功能在整个机器人生命周期内始终有效。