CN115165235B - 基于多引导机器人引导的任务机器人的定位方法 - Google Patents
基于多引导机器人引导的任务机器人的定位方法 Download PDFInfo
- Publication number
- CN115165235B CN115165235B CN202210884709.7A CN202210884709A CN115165235B CN 115165235 B CN115165235 B CN 115165235B CN 202210884709 A CN202210884709 A CN 202210884709A CN 115165235 B CN115165235 B CN 115165235B
- Authority
- CN
- China
- Prior art keywords
- robot
- robots
- guiding
- gas
- fire extinguishing
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000001514 detection method Methods 0.000 claims abstract description 21
- 230000000007 visual effect Effects 0.000 claims abstract description 11
- 239000003795 chemical substances by application Substances 0.000 claims description 49
- 241000238631 Hexapoda Species 0.000 claims description 34
- 239000011664 nicotinic acid Substances 0.000 claims description 28
- 238000009826 distribution Methods 0.000 claims description 24
- 238000004891 communication Methods 0.000 claims description 10
- 230000015572 biosynthetic process Effects 0.000 claims description 7
- 238000005507 spraying Methods 0.000 claims description 6
- 238000002347 injection Methods 0.000 claims description 4
- 239000007924 injection Substances 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 3
- 239000007789 gas Substances 0.000 description 104
- 241000510032 Ellipsaria lineolata Species 0.000 description 18
- 238000004519 manufacturing process Methods 0.000 description 3
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 3
- 239000013587 production medium Substances 0.000 description 3
- 239000002994 raw material Substances 0.000 description 3
- 229920000049 Carbon (fiber) Polymers 0.000 description 2
- 239000004917 carbon fiber Substances 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000007797 corrosion Effects 0.000 description 2
- 238000005260 corrosion Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000002609 medium Substances 0.000 description 2
- 239000003209 petroleum derivative Substances 0.000 description 2
- 241000255777 Lepidoptera Species 0.000 description 1
- 239000002390 adhesive tape Substances 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003592 biomimetic effect Effects 0.000 description 1
- 238000004517 catalytic hydrocracking Methods 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000009792 diffusion process Methods 0.000 description 1
- 238000010892 electric spark Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 230000002427 irreversible effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 230000013011 mating Effects 0.000 description 1
- 239000003345 natural gas Substances 0.000 description 1
- 230000003647 oxidation Effects 0.000 description 1
- 238000007254 oxidation reaction Methods 0.000 description 1
- 239000003208 petroleum Substances 0.000 description 1
- 238000005504 petroleum refining Methods 0.000 description 1
- 231100000614 poison Toxicity 0.000 description 1
- 230000007096 poisonous effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000007670 refining Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001988 toxicity Effects 0.000 description 1
- 231100000419 toxicity Toxicity 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M3/00—Investigating fluid-tightness of structures
- G01M3/02—Investigating fluid-tightness of structures by using fluid or vacuum
- G01M3/04—Investigating fluid-tightness of structures by using fluid or vacuum by detecting the presence of fluid at the leakage point
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C33/00—Ornithopters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C33/00—Ornithopters
- B64C33/02—Wings; Actuating mechanisms therefor
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01N—INVESTIGATING OR ANALYSING MATERIALS BY DETERMINING THEIR CHEMICAL OR PHYSICAL PROPERTIES
- G01N33/00—Investigating or analysing materials by specific methods not covered by groups G01N1/00 - G01N31/00
-
- G—PHYSICS
- G08—SIGNALLING
- G08B—SIGNALLING OR CALLING SYSTEMS; ORDER TELEGRAPHS; ALARM SYSTEMS
- G08B21/00—Alarms responsive to a single specified undesired or abnormal condition and not otherwise provided for
- G08B21/02—Alarms for ensuring the safety of persons
- G08B21/12—Alarms for ensuring the safety of persons responsive to undesired emission of substances, e.g. pollution alarms
- G08B21/16—Combustible gas alarms
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Chemical & Material Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Analytical Chemistry (AREA)
- Manipulator (AREA)
- Biochemistry (AREA)
- Medicinal Chemistry (AREA)
- Food Science & Technology (AREA)
- Pathology (AREA)
- Automation & Control Theory (AREA)
- Combustion & Propulsion (AREA)
- Environmental & Geological Engineering (AREA)
- Toxicology (AREA)
- Business, Economics & Management (AREA)
- Emergency Management (AREA)
- Immunology (AREA)
Abstract
本发明涉及一种基于多引导机器人引导的任务机器人的定位方法,包括:由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测;在气体泄漏区域内探测到气体泄漏的多个引导机器人,通过机器人的位置移动分布于泄漏点的整个的气体泄漏区域内,并通过引导机器人自身发出灯光指示信号的强弱来表征探测的机器人所在的区域点气体浓度强弱;在空间中通过灯光指示出气体泄漏区域的范围;任务机器人在引导机器人的灯光指示信号引导下进行视觉图像导航定位,行进至气体泄漏区域后,进行气体泄漏的早期控制。本发明实现气体泄漏区域的确定,并引导任务机器人到达气体泄漏区域实现对泄漏的早期控制。
Description
技术领域
本发明属于机器人技术领域,具体涉及一种基于多引导机器人引导的任务机器人的定位方法。
背景技术
石化场站是指以石油、天然气及其它产品为原料通过石化设备进行分离。液化等操作而存储输运的场所,石化生产主要由原料处理、化学反应及产品精制三大工艺过程构成,原料经预处理满足加工要求,再通过复合化学反应制得高质量产品。为满足生产介质及工艺过程的多样化需求,石油炼制及加氢裂化等生产环节通常要求设备多元化、功能多样化及输出最大化,故对石化设备性能与工况提出了严格要求。
石化设备通常面临不同压力及温度、多介质的工况条件。由于生产介质具有强腐蚀、易燃易爆及有毒有害等特性,当设备长期高负荷运行或超出阈值时,设备强度、塑性及韧性等力学性能与耐腐蚀、抗氧化等化学性能将逼近最大承载值,对设备造成不可逆变化,增加企业设备成本。
生产介质易燃﹑易爆及有毒等特性极易造成泄露安全事故。石化场站因占地面积大,生产设备类型复杂及数量庞大,电气设备运行时极易产生电火花、撞击火花等可燃源,当介质泄漏达到一定浓度时,因可控性低一旦接触可燃源即会造成火灾爆炸事故,造成巨大损失。
发明内容
鉴于上述的分析,本发明旨在公开了一种基于多引导机器人引导的任务机器人的定位方法,用于通过多引导机器人实现气体泄漏区域的确定,并在多引导机器人的引导下使任务机器人到达气体泄漏区域进行泄漏的早期控制。
本发明公开了一种基于多引导机器人引导的任务机器人的定位方法,包括:
由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测;在同一气体泄漏区域内探测到气体泄漏的多个引导机器人,通过机器人的位置移动分布于泄漏点的整个的气体泄漏区域内,并通过引导机器人自身发出灯光指示信号的强弱来表征探测的机器人所在的区域点气体浓度强弱;在空间中通过灯光指示出气体泄漏区域的范围;
任务机器人在引导机器人的灯光指示信号引导下进行视觉图像导航定位,行进至气体泄漏区域后,进行气体泄漏的早期控制。
进一步地,所述任务机器人与气体泄漏区域内的引导机器人建立无线通信链路;在任务机器人视觉图像信号丢失后,通过无线通信链路的信号强度进行信号强度指示测距;根据对气体泄漏区域内的多个引导机器人的测距,进行任务机器人的二次定位。
进一步地,所述信号强度指示测距中,RSSI值的表达式为RSSI=A-10nlg(d);A为在单位距离d0处的信号强度;n为信号衰减因子;d为发射节点到接受节点的距离。
进一步地,所述由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测的方法,包括:
探测群组内的多个引导机器人预先随机分布于搜索空间中,每个引导机器人均具有气体浓度感知功能,并将感知的气体浓度通过灯光亮度值进行标识;
引导机器人感知其所在空间位置的泄漏气体浓度,对标识感知气体浓度的灯光亮度值进行更新;
引导机器人根据与群组内其他引导机器人的距离,将灯光亮度值进行折算得到亮度值分发量,分发到对应的引导机器人,距离越远亮度值分发量越小;
每个引导机器人根据自身感知气体浓度得到的灯光亮度值和接收到的群组内其他引导机器人发送的亮度值分发量,进行机器人配对,确定出与自身进行配对的引导机器人;
在确定出与自身进行配对的引导机器人后,朝向该配对的引导机器人移动,更新机器人自身位置;
通过群组中引导机器人的位置更新,使群组内的多个引导机器人的空间位置遍布在气体的泄漏区域。
进一步地,所述引导机器人通过搭载的气体传感器感知气体浓度;并将感知气体浓度值通过电信号转换为灯光亮度值;
当前时刻t探测到气体泄漏的第i个引导机器人更新的灯光亮度值XYi(t)=max{0,b1·XYi(t-1)+b2·f(t)};式中,XYi(t-1)为上一时刻第i个引导机器人的灯光信号强度值,fi(t)为第i个引导机器人在当前时刻t所探测的泄露气体浓度值;b1和b2为常量,并满足0≤b1≤1和b2>1。
进一步地,当前时刻t第i个引导机器人对群组内的第j个引导机器人的灯光亮度值分发量:
式中,i=1,2,…,N,j=1,2,…,N,k=1,2,…,N,i≠k;dij是第i个引导机器人与第j个引导机器人之间的欧氏距离,N为群组内机器人的数量。
进一步地,所述引导机器人为仿生飞行昆虫机器人,能够在狭小空间内飞行;
仿生飞行昆虫机器人体内搭载的气体传感器,机器人的尾部设置气体浓度指示灯;所述仿生飞行昆虫机器人设有用于与群组内机器人之间以及与任务机器人之间建立数据通信链路的Zigbee模块。
进一步地,所述仿生飞行昆虫机器人为蝴蝶式机器人,包括主躯干、翅膀驱动组件与翅膀组件;主躯干内搭载的气体传感器,主躯干的尾部设置气体浓度指示灯。
进一步地,所述任务机器人包括多个行走机器人和一个移动灭火剂基站;
所述多个行走机器人中的一个为领航机器人,其他行走机器人为跟随机器人;
所述跟随机器人通过牵引绳和消防管道依次连接,最后一个跟随机器人通过牵引绳和消防管道与移动灭火剂基站连接;第一个跟随机器人通过牵引绳与领航机器人连接;每个所述跟随机器人均搭载灭火剂喷射头,并通过消防管道将灭火剂喷射头与移动灭火剂基站连接;
领航机器人,用于在多引导机器人的引导下牵引跟随机器人和移动灭火剂基站到达泄漏点附近;
所述跟随机器人,用于在到达泄漏点附近后,排成灭火队形,通过搭载的所述灭火剂喷射头向泄漏点喷射灭火剂,对气体泄漏进行早期控制,防止气体发生燃烧;
所述移动灭火剂基站,用于向跟随机器人输送灭火剂。
进一步地,所述多个行走机器人均为球形-六足变形机器人;在导航至气体泄漏区域的过程中,领航机器人展开为六足机器人,跟随机器人保持为球形;在领航机器人的牵引下,球形的跟随机器人和移动灭火剂基站向气体泄漏区域移动;在到达泄漏点附近后,跟随机器人排成灭火队形,展开为六足机器人将灭火剂喷头伸出,对准气体泄漏区域喷射灭火剂。
本发明至少可实现以下有益效果之一:
本发明的基于多引导机器人引导的任务机器人的定位方法,利用多个引导机器人实现泄漏气体空间区域确定和指示;并在多引导机器人的导航下使任务机器人到达气体泄漏区域;实现对气体泄漏的早期控制。
本发明使引导机器人按照泄漏气体浓度大小分布进行排布,并按照气体浓度大小进行泄漏指示灯亮度控制,形成从泄漏点的中心到泄漏边缘由亮到暗的气体泄漏空间区域指示,实现对泄漏区域的报警和泄漏区域的指示。
本发明的任务机器人,基于视觉图像导航定位和基于信号强度指示测距定位,两种定位方式对任务机器人进行导航定位,确保任务机器人被引导到气体泄漏区域。
采用包括蝴蝶式机器人在内的仿生飞行昆虫机器人进行探测和空间区域确定,便于在石化场站管路复杂的区域中的狭小空间通行的停留,以确定泄漏气体的空间区域。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明实施例中的基于多引导机器人引导的任务机器人的定位方法流程图;
图2为本发明实施例中的用于空间区域确定的多机器人探测方法流程图。
图3为本发明实施例中的为蝴蝶式机器人的顶视图;
图4为本发明实施例中的为蝴蝶式机器人的侧视图;
图5为本发明实施例中的为蝴蝶式机器人的前视图;
图6为本发明实施例中的为蝴蝶式机器人的立体图;
图7为本发明实施例中的一个蝴蝶式机器人探测到气体泄漏的示意图;。
图8为本发明实施例中的任务机器人进行二次定位示意图。
附图标记:1-微型舵机,2-炭纤维杆,3-弹性薄膜,4-塑料连接组件,5-翅膀组件,6-翅膀驱动组件,7-主躯干,8-前翅,9-后翅,10-无线传感器,11-微控、供电系统,12-蝴蝶机器人,13-石油气体管道,14-无线传感器,15-警示灯光,16-泄漏气体,17-裂缝,18-引导机器人组,19-任务机器人,20-领航机器人,21-跟随机器人,22-移动灭火剂基站。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。
本发明的一个实施例公开了一种基于多引导机器人引导的任务机器人的定位方法,如图1所示,包括以下步骤:
步骤S101、由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测;在同一气体泄漏区域内探测到气体泄漏的多个引导机器人,通过机器人的位置移动分布于泄漏点的整个的气体泄漏区域内,并通过引导机器人自身发出灯光指示信号的强弱来表征探测的机器人所在的区域点气体浓度强弱;在空间中通过灯光指示出气体泄漏区域的范围;
步骤S102、任务机器人在引导机器人的灯光指示信号引导下进行视觉图像导航定位,行进至气体泄漏区域后,进行气体泄漏的早期控制。
进一步地,所述任务机器人与气体泄漏区域内的引导机器人建立无线通信链路;在任务机器人视觉图像信号丢失后,通过无线通信链路的信号强度进行信号强度指示测距;通过对气体泄漏区域内的多个引导机器人的测距,进行任务机器人的二次定位。
具体的,在步骤S101中的由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测的方法,如图2所示,包括
S201、探测群组内的多个引导机器人预先随机分布于搜索空间中,每个引导机器人均具有气体浓度感知功能,并将感知的气体浓度通过灯光亮度值进行标识;
所述引导机器人通过搭载的气体传感器感知气体浓度,通过搭载的指示灯的灯光亮度值标识本地气体浓度值;
S202、引导机器人感知其所在空间位置的泄漏气体浓度,对标识感知气体浓度的灯光亮度值进行更新;
具体的,在对气体浓度标识值进行更新中,结合前一时刻的灯光亮度和当前时刻探测的气体泄露浓度值,确定当前时刻灯光亮度值;
当前时刻t探测到气体泄漏的第i个引导机器人更新的灯光亮度值XYi(t)=max{0,b1·XYi(t-1)+b2·f(t)};式中,XYi(t-1)为上一时刻第i个引导机器人的灯光信号强度值,fi(t)为第i个引导机器人在当前时刻t所探测的泄露气体浓度值;b1和b2为常量,并满足0≤b1≤1和b2>1。
S203、引导机器人根据与群组内其他引导机器人的距离,将灯光亮度值进行折算得到亮度值分发量,分发到对应的引导机器人,距离越远亮度值分发量越小;
当前时刻t第i个引导机器人对群组内的第j个引导机器人的灯光亮度值分发量:
式中,i=1,2,…,N,j=1,2,…,N,k=1,2,…,N,i≠k;dij是第i个引导机器人与第j个引导机器人之间的欧氏距离,N为群组内机器人的数量。
S204、每个引导机器人根据自身感知气体浓度得到的灯光亮度值和接收到的群组内其他引导机器人发送的亮度值分发量,进行机器人配对,确定出与自身进行配对的引导机器人;
在进行机器人配对时,引导机器人将接收到的群组内其他引导机器人发送的灯光亮度值分发量和自身传感器测量的灯光亮度值一起依照由大到小进行降序排列;选择降序排列中与自身灯光亮度值相邻的前一位的机器人作为配对机器人。
其中,机器人配对可用下式表示:
XY(ithBF)<XY(jthBF)
式中,i=1,2,…,N,j=1,2,…,N j≠i;ith、jth指的是机器人的降序指数,BF指代机器人,将与第i个机器人的降序指数ith相邻降序指数jth(即降序中相邻的前一位)的机器人与第i个机器人进行配对。
S205、在确定出与自身进行配对的引导机器人后,朝向该配对的引导机器人移动,更新机器人自身位置;
具体的,向配对机器人移动的目标位置
其中,xi(t+1)和xi(t)分别是第i个机器人在下一个时刻和当前时刻的位置;xl-mate(t)第i个机器人的配对机器人的当前时刻的位置,Bs为机器人的移动步长。
S206、通过群组中引导机器人的位置更新,使群组内的多个引导机器人的空间位置遍布在气体的泄漏区域。
为实现在一定的空间区域内使机器人能够散开,形成覆盖到整个泄漏气体区域的机器人分布。特别是在石化场站中管路复杂的区域中,通过存在狭小空间进行泄漏气体的空间区域确定,优选的,所述引导机器人为仿生飞行昆虫机器人,能够在狭小空间内飞行;
仿生飞行昆虫机器人体内搭载的气体传感器,机器人的尾部设置气体浓度指示灯。
述仿生飞行昆虫机器人设有用于与群组内机器人之间以及与任务机器人之间建立数据通信链路的Zigbee模块;设置有用于感应光强度的光传感器;设置有用于避障的超声波传感器;设置有用于定位的卫星导航模块和/微型惯导模块。
在探测过程中,如果泄漏区域中只有一个泄漏点,在该泄漏点附近有一个仿生飞行昆虫机器人,则该仿生机器人探测到泄漏气体后,通过设置在尾部的气体浓度指示灯指示出泄漏气体的浓度;附近的群组内其他的仿生飞行昆虫机器人,根据接收到的探测到泄漏气体的仿生飞行昆虫机器人的亮度值分发量,朝向该仿生飞行昆虫机器人飞行移动,当其他仿生飞行昆虫机器人飞到泄漏区域后,其搭载的气体传感器探测到泄漏气体后,通过设置在尾部的气体浓度指示灯指示出泄漏气体的浓度;当多个飞行昆虫机器人都探测到泄漏气体,通过相互分发的亮度值分发量和自身感知气体浓度得到的灯光亮度值进行机器人配对,确定出与自身进行配对的机器人,以配对机器人之间相对移动,通过群组中机器人的位置更新,使群组内多个机器人的空间位置遍布在气体的泄漏区域,泄漏区域越大,探测到泄漏气体的仿生飞行昆虫机器人越多,遍布的空间就越大,且位于泄漏区域浓度高位置的仿生飞行昆虫机器人的气体浓度指示灯的亮度更亮,浓度低位置的气体浓度指示灯的亮度低。以此在仿生飞行机器人确定的气体泄漏空间区域中,形成一个从泄漏中心到泄漏边缘从亮到暗的气体泄漏空间区域指示。
在探测过程中,如果泄漏区域中有多个泄漏点,则每个泄漏点附近仿生飞行昆虫机器人最先探测到泄漏气体,通过设置在尾部的气体浓度指示灯指示出泄漏气体的浓度;并向周围的其他仿生飞行昆虫机器人分发亮度值分发量;依照上述的探测过程,会形成围绕每个泄漏点的呈区域的仿生飞行昆虫机器人位置分布,并从每个泄漏点的中心到泄漏边缘从亮到暗的气体泄漏空间区域指示。方便对泄漏区域的报警和泄漏区域指示以及泄漏区域中心指示。
优选的,所述仿生飞行昆虫机器人为蝴蝶式机器人,包括主躯干、翅膀驱动组件与翅膀组件;主躯干内搭载的气体传感器,主躯干的尾部设置气体浓度指示灯;
其中,翅膀组件包括左翅膀组件和右翅膀组件,分别安装于主躯干前端两侧安装的翅膀驱动组件上,且镜像对称;翅膀组件中,外轮廓通过碳纤维杆弯折后通过塑料连接组件固定成型,构成蝴蝶式机器人的整体骨架,弹性薄膜根据翅膀骨架整体切割而成,并利用粘性胶带固定于翅膀骨架之上,形成弹性翅膀;翅膀组件通过主躯干前部安装的驱动舵机驱动,带动翅膀扑打,转化为飞行的推力和升力,并独立控制双翅的始末相位实现蝴蝶的俯仰及偏航;且通过主躯干后部安装的微控制系统与供电系统,实现仿生蝴蝶扑翼飞行器的控制及供电。
如图3、4、5、6所示,为蝴蝶式机器人的顶视图、侧视图、前视图和立体图。
采用蝴蝶式机器人,搭载检测石油气体泄露的传感器,在危险源地方附着,当发生泄露时,传感器探测信号,蝴蝶尾部发出可识别的灯光。蝴蝶式机器人上设有无线传感器,通过平台分发指令给100个群体为单位,寻找危险源,检测到危险源时,一个蝴蝶留下,用灯光示意泄露危险的强度,当一群蝴蝶发生同样的灯光亮度时,蝴蝶群体以队形展开寻找泄露源大小,以捕捉危险源扩散大小。见图7。
具体的,在步骤S102中,任务机器人在引导机器人的灯光指示信号引导下进行视觉图像导航定位,可采用现有的视觉导航定位方法,以搭载的摄像设备跟踪引导机器人发出的灯光指示信号,进行定位导航,使任务机器人向气体泄漏区域行进。
具体的,在任务机器人视觉图像信号丢失后,通过无线通信链路的信号强度进行信号强度指示(RSSI)测距的方法中,
RSSI定位的对数-常态分布模型的数学表达式为:
其中d为发射节点(引导机器人)到接收节点(任务机器人)的距离,单位为m;d0为单位距离,通常取1m;PL(d)为经过距离d后的路径损耗,PL(d0)为经过单位距离后的路径损耗;X0为均值为0的高斯随机数,其标准差范围为4~10;n为信号衰减因子,表示路径损失随距离增加而增大的快慢,当n取值越小时,信号在传播过程中衰减越小,信号就可以传播更远,范围一般为2~4。
接收节点(任务机器人)接收到的RSSI值表达式如下:
RSSI=Pt-PL(d)
其中Pt为发射节点的发射功率。
由上式可知:PL(d0)=Pt-A;
由于d0通常取为1m且X0的均值为0,所以上式简化为:
PL(d)=Pt-A+10nlg(d);
则RSSI值的表达式为:
RSSI=A-10nlg(d);
式中,A为在单位距离d0处的信号强度;n为信号衰减因子;d为发射节点到接受节点的距离。
如果接受节点测量到发射节点的信号在其位置的信号强度指示值RSSI,根据通过环境参数A和n就可以计算出接收节点到发射节点的距离。
利用对于最少三个引导机器人的信号强度指示测距值,通过三边定位法确定出引导机器人的位置。
在本实施例的一个具体方案中,如图8所示的任务机器人进行二次定位示意图,所述任务机器人包括多个行走机器人和一个移动灭火剂基站;
所述多个行走机器人中的一个为领航机器人,其他行走机器人为跟随机器人;
所述跟随机器人通过牵引绳和消防管道依次连接,最后一个跟随机器人通过牵引绳和消防管道与移动灭火剂基站连接;第一个跟随机器人通过牵引绳与领航机器人连接;每个所述跟随机器人均搭载灭火剂喷射头,并通过消防管道将灭火剂喷射头与移动灭火剂基站连接;
领航机器人,用于在多引导机器人的引导下牵引跟随机器人和移动灭火剂基站到达泄漏点附近后,
所述跟随机器人,用于在到达泄漏点附近后,排成灭火队形,通过搭载的所述灭火剂喷射头向泄漏点喷射灭火剂,对气体泄漏进行早期控制,防止气体发生燃烧;
所述移动灭火剂基站,用于向跟随机器人输送灭火剂。
优选的,所述多个行走机器人均为球形-六足变形机器人;所述球形-六足变形机器人,在收起状态为球形机器人,可以在地面上滚动行进,在展开状态为六足机器人,可以通过六个足进行移动,并且,领航机器人搭载摄像装置,跟随机器人搭载灭火剂喷射头,通过消防管道连接移动灭火剂基站。
在导航至气体泄漏区域的过程中,领航机器人展开为六足机器人,跟随机器人保持为球形;跟随机器人保持球形进行滚动,体积更小,通过滚动的方式行进,对路面要求低。
领航机器人牵引着球形的跟随机器人和移动灭火剂基站,向气体泄漏区域移动;在到达泄漏点附近后,跟随机器人排成灭火队形,展开为六足机器人将灭火剂喷头伸出,对准气体泄漏区域喷射灭火剂。
综上所述,本实施例公开的用于空间区域确定的多机器人探测方法,可以利用多个机器人,实现泄漏气体空间区域的探测和确定。本发明使机器人按照泄漏气体浓度大小分布进行排布,并按照气体浓度大小进行泄漏指示灯亮度控制,形成从泄漏点的中心到泄漏边缘由亮到暗的气体泄漏空间区域指示,实现对泄漏区域的报警和泄漏区域的指示。
并且,采用包括蝴蝶式机器人在内的仿生飞行昆虫机器人进行探测和空间区域确定,便于在石化场站管路复杂的区域中的狭小空间通行的停留,以确定泄漏气体的空间区域。采用球形-六足变形机器人更便于在石化场站的复杂环境中通行。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (9)
1.一种基于多引导机器人引导的任务机器人的定位方法,其特征在于,包括:
由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测;在同一气体泄漏区域内探测到气体泄漏的多个引导机器人,通过机器人的位置移动分布于泄漏点的整个的气体泄漏区域内,并通过引导机器人自身发出灯光指示信号的强弱来表征探测的机器人所在的区域点气体浓度强弱;在空间中通过灯光指示出气体泄漏区域的范围;
任务机器人在引导机器人的灯光指示信号引导下进行视觉图像导航定位,行进至气体泄漏区域后,进行气体泄漏的早期控制;
所述由多个引导机器人组成的探测群组在搜索空间中进行气体泄漏探测的方法,包括:
探测群组内的多个引导机器人预先随机分布于搜索空间中,每个引导机器人均具有气体浓度感知功能,并将感知的气体浓度通过灯光亮度值进行标识;
引导机器人感知其所在空间位置的泄漏气体浓度,对标识感知气体浓度的灯光亮度值进行更新;
引导机器人根据与群组内其他引导机器人的距离,将灯光亮度值进行折算得到亮度值分发量,分发到对应的引导机器人,距离越远亮度值分发量越小;
每个引导机器人根据自身感知气体浓度得到的灯光亮度值和接收到的群组内其他引导机器人发送的亮度值分发量,进行机器人配对,确定出与自身进行配对的引导机器人;
在确定出与自身进行配对的引导机器人后,朝向该配对的引导机器人移动,更新机器人自身位置;
通过群组中引导机器人的位置更新,使群组内的多个引导机器人的空间位置遍布在气体的泄漏区域。
2.根据权利要求1所述的任务机器人的定位方法,其特征在于,
所述任务机器人与气体泄漏区域内的引导机器人建立无线通信链路;在任务机器人视觉图像信号丢失后,通过无线通信链路的信号强度进行信号强度指示测距;根据对气体泄漏区域内的多个引导机器人的测距,进行任务机器人的二次定位。
3.根据权利要求2所述的任务机器人的定位方法,其特征在于,所述信号强度指示测距中,RSSI值的表达式为RSSI=A-10nlg(d);A为在单位距离d0处的信号强度;n为信号衰减因子;d为发射节点到接受节点的距离。
4.根据权利要求1所述的任务机器人的定位方法,其特征在于,所述引导机器人通过搭载的气体传感器感知气体浓度;并将感知气体浓度值通过电信号转换为灯光亮度值;
当前时刻t探测到气体泄漏的第i个引导机器人更新的灯光亮度值XYi(t)=max{0,b1·XYi(t-1)+b2·f(t)};式中,XYi(t-1)为上一时刻第i个引导机器人的灯光信号强度值,fi(t)为第i个引导机器人在当前时刻t所探测的泄露气体浓度值;b1和b2为常量,并满足0≤b1≤1和b2>1。
5.根据权利要求1所述的任务机器人的定位方法,其特征在于,
当前时刻t第i个引导机器人对群组内的第j个引导机器人的灯光亮度值分发量:
式中,i=1,2,…,N,j=1,2,…,N,k=1,2,…,N,i≠k;dij是第i个引导机器人与第j个引导机器人之间的欧氏距离,N为群组内机器人的数量。
6.根据权利要求1-5任一项所述的任务机器人的定位方法,其特征在于,所述引导机器人为仿生飞行昆虫机器人,能够在狭小空间内飞行;
仿生飞行昆虫机器人体内搭载的气体传感器,机器人的尾部设置气体浓度指示灯;所述仿生飞行昆虫机器人设有用于与群组内机器人之间以及与任务机器人之间建立数据通信链路的Zigbee模块。
7.根据权利要求6所述的任务机器人的定位方法,其特征在于,所述仿生飞行昆虫机器人为蝴蝶式机器人,包括主躯干、翅膀驱动组件与翅膀组件;主躯干内搭载的气体传感器,主躯干的尾部设置气体浓度指示灯。
8.根据权利要求6所述的任务机器人的定位方法,其特征在于,所述任务机器人包括多个行走机器人和一个移动灭火剂基站;
所述多个行走机器人中的一个为领航机器人,其他行走机器人为跟随机器人;
所述跟随机器人通过牵引绳和消防管道依次连接,最后一个跟随机器人通过牵引绳和消防管道与移动灭火剂基站连接;第一个跟随机器人通过牵引绳与领航机器人连接;每个所述跟随机器人均搭载灭火剂喷射头,并通过消防管道将灭火剂喷射头与移动灭火剂基站连接;
领航机器人,用于在多引导机器人的引导下牵引跟随机器人和移动灭火剂基站到达泄漏点附近;
所述跟随机器人,用于在到达泄漏点附近后,排成灭火队形,通过搭载的所述灭火剂喷射头向泄漏点喷射灭火剂,对气体泄漏进行早期控制,防止气体发生燃烧;
所述移动灭火剂基站,用于向跟随机器人输送灭火剂。
9.根据权利要求8所述的任务机器人的定位方法,其特征在于,所述多个行走机器人均为球形-六足变形机器人;在导航至气体泄漏区域的过程中,领航机器人展开为六足机器人,跟随机器人保持为球形;在领航机器人的牵引下,球形的跟随机器人和移动灭火剂基站向气体泄漏区域移动;在到达泄漏点附近后,跟随机器人排成灭火队形,展开为六足机器人将灭火剂喷头伸出,对准气体泄漏区域喷射灭火剂。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210884709.7A CN115165235B (zh) | 2022-07-25 | 2022-07-25 | 基于多引导机器人引导的任务机器人的定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210884709.7A CN115165235B (zh) | 2022-07-25 | 2022-07-25 | 基于多引导机器人引导的任务机器人的定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115165235A CN115165235A (zh) | 2022-10-11 |
CN115165235B true CN115165235B (zh) | 2024-05-31 |
Family
ID=83496508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210884709.7A Active CN115165235B (zh) | 2022-07-25 | 2022-07-25 | 基于多引导机器人引导的任务机器人的定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115165235B (zh) |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20080024290A (ko) * | 2006-09-13 | 2008-03-18 | 에스케이 텔레콤주식회사 | 로봇을 이용한 가스 누출 감지 시스템 및 방법 |
CN104848991A (zh) * | 2015-06-05 | 2015-08-19 | 天津理工大学 | 基于视觉的主动式泄漏气体检测方法 |
CN205158574U (zh) * | 2015-07-20 | 2016-04-13 | 广东石油化工学院 | 石化气体泄漏立体光标示装置 |
CN205862231U (zh) * | 2016-07-30 | 2017-01-04 | 广东石油化工学院 | 一种探测石化气体泄漏的搜索定位机器人装置 |
EP3294101A1 (en) * | 2015-05-12 | 2018-03-21 | Samsung Electronics Co., Ltd. | Robot and controlling method thereof |
CN109374589A (zh) * | 2018-11-26 | 2019-02-22 | 浙江海洋大学 | 一种采用荧光示踪剂的危险气体监测方法 |
CN110441013A (zh) * | 2019-07-09 | 2019-11-12 | 青岛北创智能科技有限公司 | 一种危险气体泄漏点确定方法、装置及机器人系统 |
CN110653831A (zh) * | 2019-09-19 | 2020-01-07 | 常熟理工学院 | 用于地下综合管廊的多寻味机器人及危险气体泄漏源定位系统和方法 |
CN111015687A (zh) * | 2019-12-31 | 2020-04-17 | 江苏顺飞信息科技有限公司 | 一种工业可燃气体泄漏源检测机器人及工作方法 |
CN111189975A (zh) * | 2020-01-08 | 2020-05-22 | 北京航天试验技术研究所 | 一种气体泄漏定位装置及定位方法 |
CN210761041U (zh) * | 2019-10-10 | 2020-06-16 | 山东科技大学 | 一种伸缩式六足燃气检测机器人 |
CN114280251A (zh) * | 2021-12-31 | 2022-04-05 | 江苏智闻智能传感科技有限公司 | 一种气体检测机器人及气体泄露源检测方法 |
CN114326745A (zh) * | 2022-01-04 | 2022-04-12 | 安徽工业大学 | 一种多机器人协同搜寻气体泄漏源的方法 |
-
2022
- 2022-07-25 CN CN202210884709.7A patent/CN115165235B/zh active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20080024290A (ko) * | 2006-09-13 | 2008-03-18 | 에스케이 텔레콤주식회사 | 로봇을 이용한 가스 누출 감지 시스템 및 방법 |
EP3294101A1 (en) * | 2015-05-12 | 2018-03-21 | Samsung Electronics Co., Ltd. | Robot and controlling method thereof |
CN104848991A (zh) * | 2015-06-05 | 2015-08-19 | 天津理工大学 | 基于视觉的主动式泄漏气体检测方法 |
CN205158574U (zh) * | 2015-07-20 | 2016-04-13 | 广东石油化工学院 | 石化气体泄漏立体光标示装置 |
CN205862231U (zh) * | 2016-07-30 | 2017-01-04 | 广东石油化工学院 | 一种探测石化气体泄漏的搜索定位机器人装置 |
CN109374589A (zh) * | 2018-11-26 | 2019-02-22 | 浙江海洋大学 | 一种采用荧光示踪剂的危险气体监测方法 |
CN110441013A (zh) * | 2019-07-09 | 2019-11-12 | 青岛北创智能科技有限公司 | 一种危险气体泄漏点确定方法、装置及机器人系统 |
CN110653831A (zh) * | 2019-09-19 | 2020-01-07 | 常熟理工学院 | 用于地下综合管廊的多寻味机器人及危险气体泄漏源定位系统和方法 |
CN210761041U (zh) * | 2019-10-10 | 2020-06-16 | 山东科技大学 | 一种伸缩式六足燃气检测机器人 |
CN111015687A (zh) * | 2019-12-31 | 2020-04-17 | 江苏顺飞信息科技有限公司 | 一种工业可燃气体泄漏源检测机器人及工作方法 |
CN111189975A (zh) * | 2020-01-08 | 2020-05-22 | 北京航天试验技术研究所 | 一种气体泄漏定位装置及定位方法 |
CN114280251A (zh) * | 2021-12-31 | 2022-04-05 | 江苏智闻智能传感科技有限公司 | 一种气体检测机器人及气体泄露源检测方法 |
CN114326745A (zh) * | 2022-01-04 | 2022-04-12 | 安徽工业大学 | 一种多机器人协同搜寻气体泄漏源的方法 |
Non-Patent Citations (3)
Title |
---|
ZXPJ01型消防机器人的研制;徐正飞, 许春权, 顿向明;机器人;20020328(第02期);第64-69页 * |
一种新的移动机器人气体泄漏源视觉搜寻方法;蒋萍;孟庆浩;曾明;李飞;李吉功;;机器人;20090915(第05期);第15-21、27页 * |
工业可燃气体泄漏源搜索机器人设计;李宁;邱选兵;嫣玉;李传亮;魏计林;麻伟杰;;化工自动化及仪表;20170610(第06期);第67-71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115165235A (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109248390B (zh) | 一种基于无人机平台的消防救援综合系统及方法 | |
Rouček et al. | Darpa subterranean challenge: Multi-robotic exploration of underground environments | |
Palomeras et al. | AUV homing and docking for remote operations | |
KR102007471B1 (ko) | 드론 관리 시스템 | |
CN110624189B (zh) | 无人机机载灭火弹装置、消防无人机以及发射控制方法 | |
CN102530256A (zh) | 一种陆空两栖任务组 | |
CN110180114B (zh) | 消防机器人协同定位、侦察、火源识别与瞄准灭火方法 | |
CN110937112B (zh) | 一种森林消防制导飞行系统及作业方法 | |
CN108785944A (zh) | 一种消防装置及消防机器人 | |
CN214633516U (zh) | 一种常态化火情巡检预警消防救援陆空机器人 | |
CN115129086B (zh) | 一种基于多引导机器人引导的多任务机器人任务执行方法 | |
CN108593213A (zh) | 无人机地下矿巡检及气味追踪装置 | |
CN111506101B (zh) | 基于通信网络拓扑结构的飞行器协同制导控制方法及系统 | |
CN113730860A (zh) | 一种未知环境下的消防机器人自主灭火方法 | |
CN109739235B (zh) | 一种仿雌蚊的移动传感器泄漏气体自动追踪方法 | |
CN115165235B (zh) | 基于多引导机器人引导的任务机器人的定位方法 | |
CN115129085B (zh) | 一种多群组机器人协同执行任务的方法 | |
CN111176331A (zh) | 一种无人机精准降落控制方法 | |
CN112295145A (zh) | 人工智能消防机器人、灾情检测方法、计算机装置及介质 | |
CN115388342A (zh) | 管网巡检方法、装置及系统 | |
Walter et al. | Extinguishing Real Fires by Fully Autonomous Multirotor UAVs in the MBZIRC 2020 Competition. | |
CN115097849B (zh) | 一种基于队形变换的多任务机器人任务执行方法 | |
CN116764147A (zh) | 一种搭载灭火装置的防爆巡检无人车 | |
CN115165236B (zh) | 用于空间区域确定的多机器人探测方法 | |
CN219275821U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |