CN110764500A - 多感官主动巡检机器人装置及其控制方法 - Google Patents

多感官主动巡检机器人装置及其控制方法 Download PDF

Info

Publication number
CN110764500A
CN110764500A CN201910940247.4A CN201910940247A CN110764500A CN 110764500 A CN110764500 A CN 110764500A CN 201910940247 A CN201910940247 A CN 201910940247A CN 110764500 A CN110764500 A CN 110764500A
Authority
CN
China
Prior art keywords
signal
early warning
signals
module
optical fiber
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201910940247.4A
Other languages
English (en)
Inventor
刘铁根
江俊峰
刘琨
于音
王双
韩迎东
李仁赟
路声跃
白易明
霍杰荣
赵晖
刘莎
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201910940247.4A priority Critical patent/CN110764500A/zh
Publication of CN110764500A publication Critical patent/CN110764500A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0251Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Acoustics & Sound (AREA)
  • Multimedia (AREA)
  • Optics & Photonics (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种多感官主动巡检机器人装置及其控制方法,包括平台界面、设置于平台底层的运动及控制模块(1)以及设置于平台上层的视觉模块(2)、光纤嗅觉模块(3)、光纤听觉模块(4)、光纤触觉模块(5)和光纤味觉模块(6)。不共线设置的所述多感官主动巡检机器人传感模块构成建立判定信号源方位的三维坐标系。本发明的一种多感官主动巡检机器人装置具有多感官立体探测、光纤传感抗极端环境、光纤传感准确度高的特点;控制方法操作科学、可替代人工、可实现主动探测的特点。

Description

多感官主动巡检机器人装置及其控制方法
技术领域
本发明属于特种机器人技术领域,特别涉及一种主要基于光纤传感的多感官主动巡检机器人装置及其控制方法。
背景技术
目前,变电站、化工厂等高危环境的巡检工作主要由基于触、摸、闻、听的人工检测方式实现,复杂的环境条件给人身安全带来巨大威胁。采用巡检机器人可以降低人工劳动强度,减少工人危险环境暴露并提升工作效率,然而现有的巡检机器人只能在常规环境下使用,其电子传感部件无法在高压、极端温度或高电磁干扰下使用,且存在质量重,响应慢和精度低的问题。
光纤传感具有质量轻、灵敏度高、响应快、耐极端耐腐蚀、抗电磁干扰等特点。
发明内容
本发明旨在提出一种多感官主动巡检机器人装置及其控制方法,利用光纤传感技术对声音、压力、应变、振动、温度等信号进行检测,运用机器视觉识别并跟踪环境中可疑物,并运用便携式光谱仪检测危险物化学成分,在发现可疑信号后,调动前述多感官传感系统对信号源进行全方位多维度分析探测,实现在极端环境极端工况下,代替人工完成复杂巡检工作,提高巡检水平,解放巡检危险。
本发明的一种多感官主动巡检机器人装置,该装置包括平台界面、设置于平台底层的运动及控制模块1以及设置于平台上层的视觉模块2、光纤嗅觉模块3、光纤听觉模块4、光纤触觉模块5和光纤味觉模块6,其中:光纤嗅觉模块3与光纤听觉模块4均为传感器阵列,光纤听觉模块4包括F-P声振动传感器组成的阵列,光纤嗅觉模块3为由激光散射PM2.5传感器31与指定气体激光内腔反馈光纤传感器32组成的双通道测试模块,均安放在不共线的位置,构建三维坐标系。
所述光纤听觉模块4选用基于双可协调激光器的光纤F-P声振动传感解调系统进行声音信号采集,其结构包括DFB双光束光源41、波分复用器42、3dB耦合器43、包括3个或3个以上分别安放于机器人非共面的位置的F-P声振动传感器的F-P声振动传感器阵列44、光电探测器45、、数据采集卡46与控制板12;两个具有不同波长的DFB激光器41输出的激光通过波分复用器42合束到单根光纤中,经3dB耦合器43入射到光纤F-P声振动传感器阵列44产生干涉,近似成双光束干涉;通过温控驱动调节光源波长,使两个波长产生的两路干涉信号正交;通过波分复用器42分离出两个波长下的光信号,并经光电探测器45转换为电信号,由数据采集卡46对两路干涉信号进行采集并传输到12控制板中进行相位计算。
所述光纤嗅觉模块3中的指定气体激光内腔反馈光纤传感器32包括宽带光源321,滤光片322,探测气室323、参考气室324与探测器325,将宽带光源321发出的光分为两路,经过两个不同波长的滤波片322进行滤光,从而得到波长邻近的λ1和λ2两个波长的光,这里λ1的光作为检测信号,通过检测气室323后由探测器325检测其光强I1;波长λ2的光作为参考信号,通过参考气室324后用探测器325测量其光强I2
不共线设置的所述多感官主动巡检机器人传感模块构成建立判定信号源方位的三维坐标系。
本发明的一种多感官主动巡检机器人控制方法,该方法具体包括如下步骤:
接收到一种或多种传感器发出的预警信号,步骤一;发送预报警信号,步骤二;根据收集到的信号预报警信号个数判断是否可以确认信号源可能方向;若是,则驱动机器人向信号源可能方向移动,步骤三;在移动过程中,获取新的传感器信号,步骤四;判断是否到达信号源位置,步骤五;若是,则作为预警情况向上位机发送全部传感器数据,步骤六;判断预警信号是否消失,步骤七;若是,则沿Z字形移动机器人,步骤八;在移动过程中,获取新的传感器信号,步骤九;再次判断预警信号是否消失,步骤十;若是,则本次预警信号处理过程完毕,结束报警,步骤十一;若根据收集到的信号个数判断不可以确认信号源方向,则判断预警信号是否消失,步骤十二;若未消失,则沿Z字形移动机器人,步骤十三;在移动过程中,获取新的传感器信号,步骤十十四,并根据收集到的信号个数判断是否可以确认信号源可能方向,步骤十五。
所述步骤一的接收到一种或多种传感器发出的预警信号,还具体包括以下处理:
将机器人放置于巡检场景;
在正常巡检场景下至少3个位置进行至少3次进行全部传感器的信号采集,标定正常信号;
在正常巡检场景下另取至少3个位置进行至少3次全部传感器的信号采集,标定正常信号变化阈值,设立警戒值;
对特殊预警信号进行采集,对采集到的特殊预警信号建立云端数据库;
一种或多种传感器接收到的信号超出所设立的警戒值,
其中所述预警信号包括以下一个或多个信号:
视觉预警信号包括出现异常物体或出现物体的异常移动;
嗅觉预警信号包括传感器信号数值超过预警值或出现特定异常气体;
听觉预警信号包括频谱或波谱出现异常波形或异常数值;
触觉预警信号包括温度、压力、应变、振动信号的异常数值、味觉预警信号指检测到异常物质。。
所述步骤二的发送预报警信号,还具体包括以下步骤:
通过无线传输向上位机发送预报警信息,提示出现传感器预警信号;
控制机器人进入预警模式,控制扬声器播放语音警告。
所述步骤五的判断是否确认信号源可能方向移动,还具体包括以下步骤:
激光雷达建立所在区域的二维地图,在此基础上建立三维空间坐标系;
依次按优先级进行信号源位置确认,当优先级高的信号已完成方向确认后,优先级低的信号作辅助信号源位置确认;
若预警信号包括视觉预警信号,则视觉信号优先级为1级,视觉信号移动轨迹方向结合视觉激光雷达对移动物体位置标定,即可判定的信号源可能方向;
若预警信号不包括视觉预警信号,至少3个同类型传感器接收到预警信号时,可确认信号源方向,优先级为2级,即3个同类型传感器信号进行数值比较,在三维空间坐标系下信号数值大的方向为信号源方向;
若预警信号不包括视觉信号,至少2个同类型传感器接收到信号时,确认信号源方向,优先级为3级,即2个同类型传感器信号进行数值比较,在三维空间坐标系下确认某一平面信号数值大的方向,该方向为信号源粗略方向;特别的,对于听觉信号,以3个听觉信号为例锁定声源坐标,空间中任意设置的三个接收器,三个接收器能定位发声声源,空间处(x0,y0,z0)存在一个声源,此声源发出的声波信息被接收器所捕捉到,此时接收到声波能流密度及其模,接收器能探测到该处的能量,同时也能搜集到该处的相位信息;联立3个传感器的6个方程求解6个未知数,有特定解,确定信号源位置(x0,y0,z0)。
所述步骤十五的根据收集到的信号个数判断是否可以确认信号源可能方向,还具体包括以下步骤:
在优先级完成确认之后:
若存在优先级1视觉预警信号,则视觉预警信号在视野中保持静止或始终在视野范围内移动,视觉雷达预警信号判定异常障碍据机器人距离小于0.2~2m,则粗确认为到达信号源位置,并进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心,允许偏离0.2-2m,若满足,则确认为到达信号源位置;
若不存在优先级1视觉预警信号,进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心;
若满足,则确认为到达信号源位置;若不满足以上条件,判定为未到达信号源位置。
与现有技术相比,本发明具有如下的有益技术效果:
(1)本发明的一种多感官主动巡检机器人控制装置具有多感官立体探测、光纤传感抗极端环境、光纤传感准确度高的特点。
(2)本发明多感官主动巡检机器人控制方法具有操作科学、可替代人工、可实现主动探测的特点。
附图说明
图1是本发明的多感官主动巡检机器人控制方法实现流程图;
图2是本发明的多感官主动巡检机器人装置模块示意图;
图3是本发明的多感官主动巡检机器人光纤嗅觉模块的指定气体激光内腔反馈光纤传感器示意图;
图4是本发明多感官主动巡检机器人光纤听觉模块结构示意图;
图5是本发明多感官主动巡检机器人光纤听觉模块F-P声振动传感器结构示意图;
图6是本发明多感官主动巡检机器人轮式优选实施方案整体示意图;
图7是本发明多感官主动巡检机器人履带式优选实施方案整体示意图;
图8是听觉信号三维坐标下确认信号源方法示意图。
附图标记:
1、运动及控制模块,2、视觉模块,3、光纤嗅觉模块,4、光纤听觉模块,5、光纤触觉模块,6、光纤味觉模块,12、控制板,21、高清摄像头,22、激光雷达,31、智泽数码SDS011型PM2.5传感器,32、二氧化碳激光内腔反馈光纤传感器,321、分布式反馈半导体激光器,322、滤光片,323、探测气室,324、参考气室,325、探测器,41、DFB双光束光源,42、波分复用器,43、3dB耦合器,44、F-P声振动传感器阵列包括3个分别安放于机器人非共面的位置的F-P声振动传感器,光电探测器45以及数据采集卡46,控制板12。441、通孔,442、D型毛细管,443、单模光纤,444、外部套管,445、超薄膜片,446、胶合部分。
具体实施方式
下面结合附图和实施例对本发明技术方案进行详细描述。。
在下述的具体描述中,附图描述了本发明的若干实施例。还可使用其他实施例,并可以在不背离本发明的精神和范围的情况下进行机械结构、电气及流程上的改变。下面的详细描述不应该被认为是限制性的,并且本发明的实施例的范围仅由公布的专利的权利要求书所限定。
本发明多感官主动巡检机器人控制方法由控制板12及上位机共同运行,包括以下步骤:一种或多种传感器接收到预警信号,向上位机发送预报警信号并根据收集到的信号个数判断是否可以确认信号源可能方向:若是,则驱动机器人向信号源可能方向移动;在移动过程中,获取新的传感器信号。判断是否到达信号源位置:若是,则作为预警情况向上位机发送全部传感器数据。判断预警信号是否消失:若是,则沿“Z”字形移动机器人,在移动过程中,获取新的传感器信号。进行二次确认再次判断预警信号是否消失:若是,则本次预警信号处理过程完毕,结束报警。若根据收集到的信号个数判断不可以确认信号源方向,则先执行判断预警信号是否消失:若未消失,则沿“Z”字形移动机器人,在移动过程中,获取新的传感器信号,并根据收集到的信号个数判断是否可以确认信号源可能方向,直至可以确认信号源可能方位或经判断预警信号已消失,流程如附图1所示。
S100一种或多种传感器接收到预警信号指视觉预警信号包括出现异常物体或出现物体的异常移动、嗅觉预警信号包括传感器信号数值超过预警值或出现特定异常气体、听觉预警信号包括频谱或波谱出现异常波形或异常数值、触觉预警信号包括温度、压力、应变、振动信号的异常数值、味觉预警信号指检测到异常物质。
S100一种或多种传感器接收到预警信号包括以下步骤:将机器人放置于巡检场景;在正常巡检场景下3个位置进行3次进行全部传感器的信号采集,标定正常信号;在正常巡检场景下另取3个位置进行3次全部传感器的信号采集,标定正常信号变化阈值,设立警戒值;对特殊预警信号进行采集,对采集到的特殊预警信号建立云端数据库;一种或多种传感器接收到的信号超出所设立的警戒值。在另一些实施例中,数量在3以上。
S200发送预报警信号包括以下步骤:通过无线传输向上位机发送预报警信息,提示出现传感器预警信号;控制机器人进入预警模式,控制18扬声器模块播放语音警告:“警告!报警模式已开启”。
S300判断是否确认信号源可能方向包括以下步骤:激光雷达建立所在区域的二维地图,在此基础上建立三维空间坐标系;依次按优先级进行信号源位置确认,当优先级高的信号已完成方向确认后,优先级低的信号作辅助信号源位置确认;若预警信号包括视觉预警信号,则视觉信号优先级为1级,视觉信号移动轨迹方向结合视觉激光雷达对移动物体位置标定,即可判定的信号源可能方向;若预警信号不包括视觉预警信号,至少3个同类型传感器接收到预警信号时,可确认信号源方向,优先级为2级,即3个同类型传感器信号进行数值比较,在三维空间坐标系下信号数值大的方向为信号源方向;若预警信号不包括视觉信号,至少2个同类型传感器接收到信号时,可粗略确认信号源方向,优先级为3级,即2个同类型传感器信号进行数值比较,在三维空间坐标系下确认某一平面信号数值大的方向,该方向为信号源粗略方向。特别的,对于听觉信号,以3个听觉信号为例锁定声源坐标。空间中任意的三个接收器,它们处于同一个平面上,接收器中心的坐标分别是(x1,y1,0)、(x2,y2,0)、(x3,y3,0)。三个接收器能定位发声声源,假设空间处(x0,y0,z0)存在一个声源,此声源发出的声波信息被接收器所捕捉到,以(x1,y1,0)处为例,此时接收到的声波能流密度及其模可用公式表达,接收器能探测到该处的能量E1可用公式计算,同时也能搜集到该处的相位信息。连立3个传感器的6个方程求解6个未知数,有特定解,可确定(x0,y0,z0)信号源位置。
S900、S1400沿“Z”字形移动机器人包括以下步骤:沿“Z”字形移动机器人,其中“Z”字横边移动距离为1m,斜边与横边成角度60°。若移动过程中完成所述确认信号源可能方向,则停止沿“Z”字形移动;若移动过程中未完成所述确认信号源可能方向,则继续沿“Z”字形移动,且其中“Z”字横边移动距离增加0.5m,斜边与横边成角度保持不变,以此循环;
S600判断是否到达信号源位置包括以下步骤:根据优先级完成确认:若存在优先级1视觉预警信号,则视觉预警信号在视野中保持静止或始终在视野范围内移动,视觉雷达预警信号判定异常障碍据机器人距离小于0.6m,则粗确认为到达信号源位置,并进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心,允许偏离0.3m,若满足,则确认为到达信号源位置;若不存在优先级1视觉预警信号,进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心,允许偏离1m,若满足,则确认为到达信号源位置。若不满足以上条件,判定为未到达信号源位置。
S700作为预警情况向上位机发送全部传感器数据包括以下步骤:通过无线传输向上位机发送到达信息及位置信息,并发送所搭载所有传感器数据,供上位机进行数据立体识别,判定预警情况;控制机器人开始全面探测,控制扬声器播放语音警告;上位机接收到预警后,向管理人员发送预警信号源提示,并将信号与云端数据库所储存特殊预警信号比对,若有匹配项,则显示匹配结果,并向管理人员发送预警信号优先级2级提示,若无匹配项,则向管理人员发送预警信号优先级1级提示,由管理人员进行信号确认。
S800、S1300判断预警信号是否消失包括以下情况:按优先级进行判定:优先级1级:上位机管理人员手动确认预警信号消失,则直接判定为预警信号消失,不再进行;优先级2级:所搭载全部传感器所接收到信号均已无预警信号,则判定为信号消失。
本次预警信号处理过程完毕,结束报警包括:向上位机发送结束报警信息,并停止语音提示;控制机器人进行日常随机巡检或按照预定轨迹进行日常巡检。
本发明多感官主动巡检机器人装置实现了5种感官的探测,且主要运用光纤传感技术,可抗高低温环境、高电磁干扰环境,且测量准确性高于传统电子传感器,所以具有多感官立体探测、光纤传感抗极端环境、光纤传感准确度高的特点。本发明多感官主动巡检机器人控制方法实现了预警信号的主动发现、主动追踪、主动调动多感官立体探测,并设置了优先级与重复确认环节,所以具有操作科学、可替代人工、可实现主动探测的特点。
如图2所示,本发明的多感官主动巡检机器人装置包括运动及控制模块1、视觉模块2、光纤嗅觉模块3、光纤听觉模块4、光纤触觉模块5、光纤味觉模块6,其中:运动及控制模块1主要设置于在机器人平台底层,视觉模块2设置于在机器人平台上层,光纤嗅觉模块3与光纤听觉模块4均为传感器阵列,光纤听觉模块4包括3个F-P声振动传感器组成的阵列,光纤嗅觉模块3为三套由激光散射PM2.5传感器与32指定气体激光内腔反馈光纤传感器组成的双通道测试模块,均安放在不共线的位置,可以构建三维坐标系。在另外一些实施例中,其数量可以在3个以上,但需保证至少有三套处于不共线位置。
运动及控制模块1包括控制板、以及分别与控制板相连接的轮式机器人平台、底盘驱动主控板、电机驱动模块、电源模块、减速编码器电机模块、九轴IMU模块以及扬声器模块(具体实施方式是将各自独立的芯片焊接到一块电路板上,也可以是其中两个或者三个组合封装成一个芯片),其中,所述控制板控制板选用内嵌ROS系统的树莓派,还可选用树莓派3B+、Inter i3工程机、RK 3399等。所述轮式机器人平台还可使用履带式机器人平台,以增强其越障能力及对于复杂环境的适应能力。所述底盘驱动主控板选用STM32F407ZGT6主控板,还可选用Arduino控制板。所述电机驱动模块选用TB6612电机驱动模块。所述电源模块选用12V、7000mAh锂电池。所述减速编码器电机模块选用2个495线编码器,各器件的具体连接采用本领域公知的连接方式。
如图6和图7所示,视觉模块2包括高清摄像头21与激光雷达22。其中,所述高清摄像头选用2台可360°旋转摄像头,当异常物体出现或移动至视野边缘时,摄像头进行旋转;在视觉结果的处理上使用深度学习SIFT方法处理高清摄像头得到的图像,可通过程序训练的方式使其实现视觉特定物体的视觉识别与追踪。所述激光雷达选用PRLDARA1激光雷达,在另外一些实施例中,可使用PRLIDARA3、YDLIDAR G4等激光雷达实现地图障碍扫描。
光纤嗅觉模块3包括智泽数码SDS011型PM2.5传感器31与二氧化碳激光内腔反馈光纤传感器32,实现双通道测量。在另外一些实施例中,所述智泽数码SDS011型PM2.5传感器31可为基于激光散射PM10传感器31,所述二氧化碳激光内腔反馈光纤传感器32为一氧化碳激光内腔反馈光纤传感器。如图3所示,其中,二氧化碳激光内腔反馈光纤传感器32包括分布式反馈半导体激光器321、滤光片322、探测气室323、参考气室324以及探测器325,将分布式反馈半导体激光器321发出的光分为两路,经过两个不同波长的滤波片322进行滤光,从而得到波长邻近的λ1和λ2两个波长的光。其中,λ1在二氧化碳气体吸收峰(波数为6988cm-1)上,而λ2对指定气体吸收很弱或者不吸收,这里λ1的光作为检测信号,通过探测气室323后由探测器检测其光强I1;波长λ2的光作为参考信号,通过参考气室324后用探测器325测量其光强I2对于I1和I2,根据朗伯吸收定律反算二氧化碳气体浓度。并通过三套不共线的多感官主动巡检机器人装置建立三维坐标系,通过比较三套系统测得数值判定信号源方位。
如图4和图5所示,光纤听觉模块4选用基于双可协调激光器的光纤F-P声振动传感解调系统进行声音信号采集,其结构包括DFB双光束光源41,波分复用器42,3dB耦合器43,F-P声振动传感器阵列44包括3个分别安放于机器人非共面的位置的F-P声振动传感器,光电探测器45以及数据采集卡46,控制板12。F-P声振动传感器阵列44结构包括通孔441、D型毛细管442、单模光纤443、外部套管444、超薄膜片445与胶合部分446。使两个具有不同波长的DFB激光器41输出的激光通过波分复用器42合束到单根光纤中,经3dB耦合器43入射到光纤F-P声振动传感器阵列44产生干涉,由于两个反射面的反射率均非常小,可近似成双光束干涉。通过温控驱动调节光源波长,可使两个波长产生的两路干涉信号正交。通过波分复用器32分离出两个波长下的光信号,并经光电探测器45转换为电信号,然后由数据采集卡46对两路干涉信号进行采集并传输到控制板12中进行相位计算。
光纤触觉模块5选择美国Optiphase全光纤M-Z干涉仪,工作波长从1064nm到1550nm,其探测器安装于轮式机器人侧面,在另外一些实施例中,根据所应用场景不同,也可安装于上表面或底盘。
光纤味觉模块6包括美国Enspectr光谱仪器有限公司的RaPort手持拉曼光谱分析仪及检测室,其中手持拉曼光谱分析仪安装在检测室内,检测室选择石英材料,有可打开的盖板,实际使用过程中可将材料放入检测室,在另外一些实施例中,根据应用场景不同,也可安装于可旋转支架上,可调整拉曼光谱分析仪角度实现不使用检测室的直接测量。
(1)使用本发明多感官主动巡检机器人前须确保电源电量充足,信号传输畅通;
(2)使用本发明多感官主动巡检机器人时,需先将机器人放置于巡检场景;在正常巡检场景下至少3个位置进行至少3次进行全部传感器的信号采集,标定正常信号;在正常巡检场景下另取至少3个位置进行至少3次全部传感器的信号采集,标定正常信号变化阈值,设立警戒值;对特殊预警信号进行采集,对采集到的特殊预警信号建立云端数据库;
(3)使用本发明多感官主动巡检机器人时,使机器人自主进行规定路径或随机路径的巡逻,在巡检过程中若发现任意感官预警情况,即可按照所述多感官主动巡检机器人控制方法进行预警信号的处理与报警,在处理完毕后,再次使机器人自主进行规定路径或随机路径的巡逻。
应当理解为,本发明的保护范围包括但不限于以上描述,本发明的保护范围以权利要求书为准,任何对本技术做出的本领域的技术人员容易想到的替换、变形、改进均应落入本发明的保护范围。

Claims (11)

1.一种多感官主动巡检机器人装置,其特征在于,该装置包括平台界面、设置于平台底层的运动及控制模块(1)以及设置于平台上层的视觉模块(2)、光纤嗅觉模块(3)、光纤听觉模块(4)、光纤触觉模块(5)和光纤味觉模块(6),其中:光纤嗅觉模块(3)与光纤听觉模块(4)均为传感器阵列,光纤听觉模块(4)是由F-P声振动传感器组成的阵列,光纤嗅觉模块(3)是由激光散射PM2.5传感器(31)与指定气体激光内腔反馈光纤传感器(32)组成的双通道测试模块,均安放在不共线的位置,构建三维坐标系。
2.如权利要求1所述的一种多感官主动巡检机器人装置,其特征在于,所述光纤听觉模块(4)选用基于双可协调激光器的光纤F-P声振动传感解调系统进行声音信号采集,其结构包括DFB双光束光源(41)、波分复用器(42)、3dB耦合器(43)、分别安放于机器人非共面的位置的F-P声振动传感器的F-P声振动传感器阵列(44)、光电探测器(45)、数据采集卡(46)与控制板(12);两个具有不同波长的DFB激光器(41)输出的激光通过波分复用器(42)合束到单根光纤中,经3dB耦合器(43)入射到光纤F-P声振动传感器阵列(44)产生干涉,近似成双光束干涉;通过温控驱动调节光源波长,使两个波长产生的两路干涉信号正交;通过波分复用器(42)分离出两个波长下的光信号,并经光电探测器(45)转换为电信号,由数据采集卡(46)对两路干涉信号进行采集并传输到(12)控制板中进行相位计算。
3.如权利要求1所述的一种多感官主动巡检机器人装置,其特征在于,所述视觉模块(2)包括激光雷达(22)及高清摄像头(21),其中激光雷达(22)结合算法应用于巡检机器人移动过程中基础地图构建及障碍物判断,高清摄像头(21)结合算法用于环境识别、物体识别、移动追踪等视觉功能实现。
4.如权利要求1所述的一种多感官主动巡检机器人装置,其特征在于,所述光纤味觉模块(6)是运用物理、化学手段完成巡检过程中对所提取物质的化学成分分析。所述光纤触觉模块(5)通过传感器测量物体周围气体的压强、密度和温度等理化参数的变化实现对物体的触觉感知。
5.如权利要求1所述的一种多感官主动巡检机器人装置,其特征在于,所述光纤嗅觉模块(3)的指定气体激光内腔反馈光纤传感器(32)中包括宽带光源(321)、滤光片(322)、探测气室(323)、参考气室(324)与探测器(325),将宽带光源(321)发出的光分为两路,经过两个不同波长的滤波片(322)进行滤光,从而得到波长邻近的λ1和λ2两个波长的光,这里λ1的光作为检测信号,通过检测气室(323)后由探测器(325)检测其光强I1;波长λ2的光作为参考信号,通过参考气室(324)后用探测器(325)测量其光强I2
6.如权利要求1所述的一种多感官主动巡检机器人装置,其特征在于,不共线设置的所述多感官主动巡检机器人传感模块构成建立判定信号源方位的三维坐标系。
7.一种多感官主动巡检机器人控制方法,其特征在于,该方法具体包括如下步骤或以下步骤的变形:
接收到一种或多种传感器发出的预警信号,步骤一;发送预报警信号,步骤二;根据收集到的信号预报警信号个数判断是否可以确认信号源可能方向;若是,则驱动机器人向信号源可能方向移动,步骤三;在移动过程中,获取新的传感器信号,步骤四;判断是否到达信号源位置,步骤五;若是,则作为预警情况向上位机发送全部传感器数据,步骤六;判断预警信号是否消失,步骤七;若是,则沿Z字形移动机器人,步骤八;在移动过程中,获取新的传感器信号,步骤九;再次判断预警信号是否消失,步骤十;若是,则本次预警信号处理过程完毕,结束报警,步骤十一;若根据收集到的信号个数判断不可以确认信号源方向,则判断预警信号是否消失,步骤十二;若未消失,则沿Z字形移动机器人,步骤十三;在移动过程中,获取新的传感器信号,步骤十四;并根据收集到的信号个数判断是否可以确认信号源可能方向,步骤十五。
8.如权利要求7所述的一种多感官主动巡检机器人控制方法,其特征在于,所述步骤一的接收到一种或多种传感器发出的预警信号,还具体包括以下处理:
将机器人放置于巡检场景;
在正常巡检场景下进行全部传感器的信号采集,标定正常信号;
在正常巡检场景下进行全部传感器的信号采集,标定正常信号变化阈值,设立警戒值;
对特殊预警信号进行采集,对采集到的特殊预警信号建立云端数据库;
一种或多种传感器接收到的信号超出所设立的警戒值;
其中所述预警信号包括以下一个或多个信号:
视觉预警信号包括出现异常物体或出现物体的异常移动;
嗅觉预警信号包括传感器信号数值超过预警值或出现特定异常气体;
听觉预警信号包括频谱或波谱出现异常波形或异常数值;
触觉预警信号包括温度、压力、应变、振动信号的异常数值、味觉预警信号指检测到异常物质。
9.如权利要求7所述的一种多感官主动巡检机器人控制方法,其特征在于,所述步骤二的发送预报警信号,还具体包括以下步骤:
向上位机发送预报警信息,提示出现传感器预警信号;
控制机器人进入预警模式,控制扬声器播放语音警告。
10.如权利要求5所述的一种多感官主动巡检机器人控制方法,其特征在于,所述步骤五的判断是否确认信号源可能方向移动,还具体包括以下步骤:
激光雷达建立所在区域的二维地图,在此基础上建立三维空间坐标系;
依次按优先级进行信号源位置确认,当优先级高的信号已完成方向确认后,优先级低的信号作辅助信号源位置确认;
若预警信号包括视觉预警信号,则视觉信号优先级为1级,视觉信号移动轨迹方向结合视觉激光雷达对移动物体位置标定,即可判定的信号源可能方向;
若预警信号不包括视觉预警信号,至少3个同类型传感器接收到预警信号时,可确认信号源方向,优先级为2级,即3个同类型传感器信号进行数值比较,在三维空间坐标系下信号数值大的方向为信号源方向;
若预警信号不包括视觉信号,至少2个同类型传感器接收到信号时,确认信号源方向,优先级为3级,即2个同类型传感器信号进行数值比较,在三维空间坐标系下确认某一平面信号数值大的方向,该方向为信号源粗略方向;特别的,对于听觉信号,以3个听觉信号为例锁定声源坐标,空间中任意设置的三个接收器,三个接收器能定位发声声源,空间处(x0,y0,z0)存在一个声源,此声源发出的声波信息被接收器所捕捉到,此时接收到声波能流密度及其模,接收器能探测到该处的能量,同时也能搜集到该处的相位信息;对信号源位置求解,有特定解,确定信号源位置(x0,y0,z0)。
11.如权利要求5所述的一种多感官主动巡检机器人控制方法,其特征在于,所述步骤十五的根据收集到的信号个数判断是否可以确认信号源可能方向,还具体包括以下步骤:
在优先级完成确认之后:
若存在优先级1视觉预警信号,则视觉预警信号在视野中保持静止或始终在视野范围内移动,视觉雷达预警信号判定异常障碍据机器人距离小于0.2~2m,则粗确认为到达信号源位置,并进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心,若满足,则确认为到达信号源位置;
若不存在优先级1视觉预警信号,进行优先级2、优先级3信号验证,验证多个传感器所确定信号源位置是否为多个传感器所确定三维空间中心或二维平面中心;
若满足,则确认为到达信号源位置;若不满足以上条件,判定为未到达信号源位置。
CN201910940247.4A 2019-09-30 2019-09-30 多感官主动巡检机器人装置及其控制方法 Pending CN110764500A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910940247.4A CN110764500A (zh) 2019-09-30 2019-09-30 多感官主动巡检机器人装置及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910940247.4A CN110764500A (zh) 2019-09-30 2019-09-30 多感官主动巡检机器人装置及其控制方法

Publications (1)

Publication Number Publication Date
CN110764500A true CN110764500A (zh) 2020-02-07

Family

ID=69329099

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910940247.4A Pending CN110764500A (zh) 2019-09-30 2019-09-30 多感官主动巡检机器人装置及其控制方法

Country Status (1)

Country Link
CN (1) CN110764500A (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112327868A (zh) * 2020-11-18 2021-02-05 无锡洛科奇科技有限公司 一种智能机器人自动导航系统
CN112709935A (zh) * 2020-12-09 2021-04-27 解光有 一种基于人工智能感官的装备气体泄漏监测系统及方法
CN113251942A (zh) * 2021-07-14 2021-08-13 四川大学 基于应变和声波传感的发电机定子故障监测的方法和装置
CN114452564A (zh) * 2021-12-21 2022-05-10 康威通信技术股份有限公司 一种前端智能灭火机器人及其工作方法
CN116972780A (zh) * 2023-09-25 2023-10-31 北京锐达仪表有限公司 具有物表温度和/或气体分布测量功能的三维扫描装置

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101413811A (zh) * 2008-11-27 2009-04-22 河北工业大学 一种危险品目标自主辨识的方法
CN101801012A (zh) * 2010-01-29 2010-08-11 东南大学 混杂式传感器网络移动节点自适应定位方法
US20120001058A1 (en) * 2009-12-21 2012-01-05 University Of Wyoming Multi-aperture visual sensor with hyperacuity
CN102542294A (zh) * 2011-12-29 2012-07-04 河海大学常州校区 双视觉信息融合的集控式足球机器人识别系统及识别方法
CN103955030A (zh) * 2014-04-09 2014-07-30 天津大学 一种锥形折射的多通道光纤旋转连接器
CN104142383A (zh) * 2014-07-31 2014-11-12 天津大学 基于信息融合的分层渐进烟羽跟踪方法
CN206573129U (zh) * 2017-03-27 2017-10-20 宁海县雁苍山电力建设有限公司 一种配电房巡检机器人导航系统
CN110039552A (zh) * 2019-04-03 2019-07-23 中铁建设集团有限公司 一种工程管理智能机器人
CN110112664A (zh) * 2019-03-28 2019-08-09 闽南理工学院 一种基于vr的变电站巡检方法和系统以及设备

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101413811A (zh) * 2008-11-27 2009-04-22 河北工业大学 一种危险品目标自主辨识的方法
US20120001058A1 (en) * 2009-12-21 2012-01-05 University Of Wyoming Multi-aperture visual sensor with hyperacuity
CN101801012A (zh) * 2010-01-29 2010-08-11 东南大学 混杂式传感器网络移动节点自适应定位方法
CN102542294A (zh) * 2011-12-29 2012-07-04 河海大学常州校区 双视觉信息融合的集控式足球机器人识别系统及识别方法
CN103955030A (zh) * 2014-04-09 2014-07-30 天津大学 一种锥形折射的多通道光纤旋转连接器
CN104142383A (zh) * 2014-07-31 2014-11-12 天津大学 基于信息融合的分层渐进烟羽跟踪方法
CN206573129U (zh) * 2017-03-27 2017-10-20 宁海县雁苍山电力建设有限公司 一种配电房巡检机器人导航系统
CN110112664A (zh) * 2019-03-28 2019-08-09 闽南理工学院 一种基于vr的变电站巡检方法和系统以及设备
CN110039552A (zh) * 2019-04-03 2019-07-23 中铁建设集团有限公司 一种工程管理智能机器人

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
芮延年,等: "《机电一体化系统设计》", 31 January 2017 *
贾云伟,等: "视觉导航用多功能路标设计与应用", 《光电子·激光》 *
郭继坤, 陈司晗: "矿井下分布式光纤定位精度及感测距离研究", 《吉林大学学报(信息科学版)》 *
顾宏灿,等: "光纤激光水听器阵列实验研究", 《光电子·激光》 *
魏冬明: "基于谐波检测原理的双气室气体传感器研究", 《光电子·激光》 *

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112327868A (zh) * 2020-11-18 2021-02-05 无锡洛科奇科技有限公司 一种智能机器人自动导航系统
CN112709935A (zh) * 2020-12-09 2021-04-27 解光有 一种基于人工智能感官的装备气体泄漏监测系统及方法
CN113251942A (zh) * 2021-07-14 2021-08-13 四川大学 基于应变和声波传感的发电机定子故障监测的方法和装置
CN113251942B (zh) * 2021-07-14 2021-09-14 四川大学 基于应变和声波传感的发电机定子故障监测的方法和装置
CN114452564A (zh) * 2021-12-21 2022-05-10 康威通信技术股份有限公司 一种前端智能灭火机器人及其工作方法
CN114452564B (zh) * 2021-12-21 2023-11-07 康威通信技术股份有限公司 一种前端智能灭火机器人及其工作方法
CN116972780A (zh) * 2023-09-25 2023-10-31 北京锐达仪表有限公司 具有物表温度和/或气体分布测量功能的三维扫描装置
CN116972780B (zh) * 2023-09-25 2024-01-26 北京锐达仪表有限公司 具有物表气体分布测量或者物表温度及气体分布测量功能的三维扫描装置

Similar Documents

Publication Publication Date Title
CN110764500A (zh) 多感官主动巡检机器人装置及其控制方法
CN111070180B (zh) 基于ros的灾后救援通道检测机器人
CN105805560A (zh) 一种基于无人机的天然气管道泄漏检测系统
CN110889455A (zh) 一种化工园巡检机器人的故障检测定位及安全评估方法
CN106774384A (zh) 一种桥梁检测智能避障机器人
CN103235562A (zh) 变电站基于巡检机器人的综合参数检测系统及巡检方法
CN111624641A (zh) 一种防爆型油库区智能巡检机器人
CN103630474A (zh) 多车道机动车尾气pm2.5遥测装置
CN106640195B (zh) 矿井爆炸监测报警系统
CN113376252A (zh) 一种变电站主设备运行状态声学移动巡检装置
CN113730860A (zh) 一种未知环境下的消防机器人自主灭火方法
CN105788123A (zh) 一种动态实时监测森林砍伐的方法及其系统
CN115793649A (zh) 一种电缆沟自动巡检装置及巡检方法
CN116680786A (zh) 一种适用于电力隧道运维的数字孪生建模系统
CN110992418B (zh) 一种导线覆冰厚度监测系统及方法
CN114112972B (zh) 一种密闭空间sf6气体泄漏红外遥测装置及其成像定位方法
CN105425808A (zh) 机载式室内气体遥测系统及方法
CN117532634A (zh) 一种加氢站智能巡检机器人系统
CN108538007A (zh) 一种基于雷达避障小车平台的室内火灾预警系统及方法
CN105203485A (zh) 室内气体的检测装置及方法
CN112362546B (zh) 一种高精度多波段便携式颗粒物质量浓度测量仪
KR102498409B1 (ko) 선박의 용접선 검사 장치
CN205068170U (zh) 机载定位装置及机载式室内气体遥测系统
CN114062302A (zh) 用于太赫兹成像检测的配网自主巡检方法
CN214277928U (zh) 一种基于红外气云成像的探测机器人

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20200207

WD01 Invention patent application deemed withdrawn after publication