CN107899166A - 基于无人机和智能消防机器人的精确灭火***及方法 - Google Patents
基于无人机和智能消防机器人的精确灭火***及方法 Download PDFInfo
- Publication number
- CN107899166A CN107899166A CN201711283478.XA CN201711283478A CN107899166A CN 107899166 A CN107899166 A CN 107899166A CN 201711283478 A CN201711283478 A CN 201711283478A CN 107899166 A CN107899166 A CN 107899166A
- Authority
- CN
- China
- Prior art keywords
- fire
- control module
- robot
- module
- gps
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 241000876443 Varanus salvator Species 0.000 claims abstract description 42
- 238000012544 monitoring process Methods 0.000 claims abstract description 21
- 238000004891 communication Methods 0.000 claims description 28
- 230000001681 protective effect Effects 0.000 claims description 10
- 238000001931 thermography Methods 0.000 claims description 10
- 238000002347 injection Methods 0.000 claims description 9
- 239000007924 injection Substances 0.000 claims description 9
- 238000000465 moulding Methods 0.000 claims description 7
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims 1
- 238000012545 processing Methods 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A62—LIFE-SAVING; FIRE-FIGHTING
- A62C—FIRE-FIGHTING
- A62C31/00—Delivery of fire-extinguishing material
-
- A—HUMAN NECESSITIES
- A62—LIFE-SAVING; FIRE-FIGHTING
- A62C—FIRE-FIGHTING
- A62C37/00—Control of fire-fighting equipment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
- B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64F—GROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
- B64F1/00—Ground or aircraft-carrier-deck installations
- B64F1/02—Ground or aircraft-carrier-deck installations for arresting aircraft, e.g. nets or cables
- B64F1/025—Ground or aircraft-carrier-deck installations for arresting aircraft, e.g. nets or cables using decelerating or arresting beds
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2101/00—UAVs specially adapted for particular uses or applications
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- Public Health (AREA)
- Business, Economics & Management (AREA)
- Emergency Management (AREA)
- Remote Sensing (AREA)
- Fire-Extinguishing By Fire Departments, And Fire-Extinguishing Equipment And Control Thereof (AREA)
Abstract
本发明公开了基于无人机和智能消防机器人的精确灭火***及方法,所述***包括智能消防机器人、无人机起落平台、消防水炮、航姿传感器、GPS、旋翼无人机、红外热像仪、双波段可见光摄像机、激光测距传感器、机载云台、远程监控终端。所述灭火方法包括旋翼无人机利用GPS、激光测距传感器、航姿传感器、机载云台和图像处理技术对火点和射流落点依次进行精确定位,智能消防机器人根据定位信息不断调整消防水炮的航向角和俯仰角,从而使射流落点精确覆盖火点区域,形成闭环精确灭火。本发明可以弥补大射程室外大空间智能消防机器人视野空间不足,火点定位不精确,灭火精度和智能化程度不高的问题,实现闭环精确灭火。
Description
技术领域
本发明涉及消防设备技术领域,尤其涉及基于无人机和智能消防机器人的精确灭火***及方法。
背景技术
随着智能消防机器人技术的不断发展,智能消防机器人被越来越多的用于各种事故救援现场,智能消防机器人的射程也越来越远,现有的智能消防机器人主要依靠图像处理技术实现火源的定位,有的通过射流轨迹数据库查表来调整消防水炮到相应的角度来灭火,有的通过射流轨迹模型方程调整消防水炮到相应的角度来灭火。这些数据库和模型大多是在一定实验环境下得到的,并非在其余的环境下都保持准确性,存在一定的偏差。另外由于火源定位的误差,风和其余环境因素影响等,往往使射流落点无法精确打中火源。
基于机器视觉技术的火点与射流落点相对位置调整的消防水炮角度控制方法是一种可以实现精确灭火的方法,但其主要用于悬挂式消防水炮,其视觉摄像机和消防水炮需要安装在建筑物的高处,使着火区域完全置于消防水炮和摄像机的视野之下。现有的智能消防机器人的视觉***和消防水炮基本都安装在其本体上,难以获得足够的视野,难以实现火源和射流落点的精确定位,难以实现自动精确灭火。
发明内容
本发明所要解决的技术问题是针对背景技术中所涉及到的缺陷,提供基于无人机和智能消防机器人的精确灭火***及方法。
本发明为解决上述技术问题采用以下技术方案:
基于无人机和智能消防机器人的精确灭火***,包括智能消防机器人、旋翼无人机和远程监控终端;
所述智能消防机器人包含机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、地面控制模块、第一航姿传感器和无人机起落平台;
所述机器人本体用于根据地面控制模块的指令运动到指定地点;
所述消防水炮设置在所述机器人本体上,用于根据地面控制模块的指令调整其航向角和俯仰角、以及喷射或停止喷射;
所述第一航姿传感器设置在所述消防水炮上,用于感应消防水炮航向角和俯仰角,并将其传递给所述地面控制模块;
所述第一GPS模块用于感应所述机器人本体的GPS坐标,并将其传递给所述地面控制模块;
所述第一无线通讯模块用于和所述旋翼无人机、远程监控终端进行通讯;
所述无人机起落平台包含直流电磁吸盘和电磁吸盘保护壳,所述电磁吸盘保护壳将直流电磁吸盘包含在其中;所述直流电磁吸盘用于在通电时产生吸力使得所述旋翼无人机安稳的停靠在电磁吸盘保护壳上、在断电时松开所述旋翼无人机;
所述地面控制模块分别和所述机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、第一航姿传感器、直流电磁吸盘电气相连;
所述旋翼无人机包含无人机本体、机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块、机载控制模块和旋翼无人机支撑架;
所述无人机本体用于根据机载控制模块进行飞行和降落;
所述第二GPS模块用于感应所述无人机本体的GPS坐标,并将其传递给所述机载控制模块;
所述机载云台设置在所述无人机上,用于搭载所述第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器,并根据机载控制模块的指令进行水平和垂直转动;
所述第二航姿传感器用于感应所述机载云台航向角和俯仰角,并将其传递给所述机载控制模块;
所述双波段可见光摄像机用于拍摄实时画面,并将其传递给所述机载控制模块;
所述红外热像仪用于火点、射流轨迹及落点的识别,并将识别信息传递给所述机载控制模块;
所述激光测距传感器用于感应火点和射流落点的距离,并将其传递给所述机载控制模块;
所述第二通讯模块用于和所述第一无线通讯模块、远程监控终端进行通讯;
所述旋翼无人机支撑架设置在所述无人机本体上,其外设有磁性物质层,用于无人机本体停靠在所述无人机起落平台;
所述机载控制模块分别和所述机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块电气相连;
所述远程监控终端用于远程控制所述远程监控终端和智能消防机器人。
本发明还公开了一种该基于无人机和智能消防机器人的精确灭火***的灭火方法,包含如下步骤:
步骤2.1),到达事故现场后,首先由操作人员控制通过远程监控终端控制旋翼无人机从智能消防机器人的起落平台起飞,进行火点的搜寻,搜寻到火点后,操作人员根据第二无线通讯模块回传的热像仪、双波段可见光摄像机图像以及激光测距传感器的测距信息,将旋翼无人机悬停于火点上方;
步骤2.2),根据接收到的第二GPS模块感应到的GPS坐标信息,操作人员通过远程监控终端无线控制智能消防机器人运动到距离火点预设的距离阈值处;
地面控制模块记录下此时第一GPS模块感应到的GPS坐标和消防水炮的航向角θ1,将此时第一GPS模块感应到的GPS坐标作为M坐标系的原点O(0,0),并以正东为M坐标系X轴的正方向,正北为M坐标系Y轴的正方向;
步骤2.3),地面控制模块发送火点跟踪指令给所述机载控制模块,机载控制模块接收到火点跟踪指令后,控制机载云台使火点中心处于热像仪图像中心,并将第二GPS模块感应到的GPS坐标、机载云台的航向角α1、机载云台的俯仰角β1、激光测距传感器测得的距离L1通过第二无线通讯模块发送给地面控制模块;
步骤2.4),地面控制模块将接收到的无人机第二GPS模块感应到的GPS坐标转化为M坐标系下的坐标,记为A(X0,Y0),再根据事故地区地球真北与磁北的偏角ψ,求得火点中心在M坐标系下的坐标为B(X1,Y1),计算公式如下:
根据以下公式求得火点中心到智能消防机器人的直线距离S1:
根据以下公式计算出火点的航向角,即OB直线的航向角为σ1:
步骤2.5),地面控制模块控制消防水炮水平转动,直至其航向角为σ1,使消防水炮在水平方向对准着火点,然后根据距离S1调整消防水炮的俯仰角和喷射流量后,控制消防水炮进行喷射,并发送射流落点跟踪指令给所述机载控制模块;
步骤2.6),机载控制模块接收到射流落点跟踪指令后,控制机载云台使射流落点处于热像仪图像中心,并将此时机载云台的航向角α2、机载云台的俯仰角β2、激光测距传感器测得的距离L2通过第二无线通讯模块发送给地面控制模块;
步骤2.7),地面控制模块按照以下公式计算得到射流落点在M坐标系的坐标为C(X2,Y2):
然后按照以下公式计算得到射流落点的航向角,即直线OC的航向角为σ2:
步骤2.8),智能消防机器人的地面控制模块根据落点坐标C(X2,Y2)和σ2,控制消防水炮首先调整水平角度,直至σ2=σ1,然后控制消防水炮俯仰角使射流落点的坐标和B重合;
步骤2.9),重复步骤2.3)至步骤2.9),直至火点被扑灭。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
1、本发明利用旋翼无人机可以解决现有智能消防机器人视野不足的问题,可实现全方位的火点搜寻与定位,加快抢救速度。
2、本发明利用GPS、航姿传感器、机载云台、激光测距传感器和图像处理技术可实现火点和射流落点的精确定位,可利用建立起的数学模型实现消防水炮的精确控制,实现闭环精确灭火。
附图说明
图1是旋翼无人机和智能消防机器人灭火***图;
图2是智能消防机器人的结构示意图;
图3是智能消防机器人的电气连接示意图;
图4是旋翼无人机的结构示意图;
图5是旋翼无人机的电气连接示意图;
图6是以智能消防机器人为中心所构建的M坐标系;
图7是旋翼无人机和智能消防机器人灭火的流程示意图。
图中,1-远程监控终端,2-智能消防机器人,3-无人机,4-火点,5-地面控制模块,6-消防水炮,7-第一航姿传感器,8-电磁吸盘,9-第一无线通讯模块,10-第一GPS模块,11-电磁吸盘保护壳,12-双波段可见光摄像机,13-激光测距传感器,14-热像仪,15-机载云台,16-第二航姿传感器,17-机载控制模块,18-第二GPS模块,19-第二无线通讯模块,20-无人机支撑架。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
本发明可以以许多不同的形式实现,而不应当认为限于这里所述的实施例。相反,提供这些实施例以便使本公开透彻且完整,并且将向本领域技术人员充分表达本发明的范围。
如图1所示,本发明公开了一种基于无人机和智能消防机器人的精确灭火***,包括智能消防机器人、旋翼无人机和远程监控终端;
如图2和图3所示,所述智能消防机器人包含机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、地面控制模块、第一航姿传感器和无人机起落平台;
所述机器人本体用于根据地面控制模块的指令运动到指定地点;
所述消防水炮设置在所述机器人本体上,用于根据地面控制模块的指令调整其航向角和俯仰角、以及喷射或停止喷射;
所述第一航姿传感器设置在所述消防水炮上,用于感应消防水炮航向角和俯仰角,并将其传递给所述地面控制模块;
所述第一GPS模块用于感应所述机器人本体的GPS坐标,并将其传递给所述地面控制模块;
所述第一无线通讯模块用于和所述旋翼无人机、远程监控终端进行通讯;
所述无人机起落平台包含直流电磁吸盘和电磁吸盘保护壳,所述电磁吸盘保护壳将直流电磁吸盘包含在其中;所述直流电磁吸盘用于在通电时产生吸力使得所述旋翼无人机安稳的停靠在电磁吸盘保护壳上、在断电时松开所述旋翼无人机;
所述地面控制模块分别和所述机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、第一航姿传感器、直流电磁吸盘电气相连;
如图4和图5所示,所述旋翼无人机包含无人机本体、机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块、机载控制模块和旋翼无人机支撑架;
所述无人机本体用于根据机载控制模块进行飞行和降落;
所述第二GPS模块用于感应所述无人机本体的GPS坐标,并将其传递给所述机载控制模块;
所述机载云台设置在所述无人机上,用于搭载所述第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器,并根据机载控制模块的指令进行水平和垂直转动;
所述第二航姿传感器用于感应所述机载云台航向角和俯仰角,并将其传递给所述机载控制模块;
所述双波段可见光摄像机用于拍摄实时画面,并将其传递给所述机载控制模块;
所述红外热像仪用于火点、射流轨迹及落点的识别,并将识别信息传递给所述机载控制模块;
所述激光测距传感器用于感应火点和射流落点的距离,并将其传递给所述机载控制模块;
所述第二通讯模块用于和所述第一无线通讯模块、远程监控终端进行通讯;
所述旋翼无人机支撑架设置在所述无人机本体上,其外设有磁性物质层,用于无人机本体停靠在所述无人机起落平台;
所述机载控制模块分别和所述机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块电气相连;
所述远程监控终端用于远程控制所述远程监控终端和智能消防机器人。
如图6和图7所示,本发明还公开了一种该基于无人机和智能消防机器人的精确灭火***的灭火方法,包含如下步骤:
步骤2.1),到达事故现场后,首先由操作人员控制通过远程监控终端控制旋翼无人机从智能消防机器人的起落平台起飞,进行火点的搜寻,搜寻到火点后,操作人员根据第二无线通讯模块回传的热像仪、双波段可见光摄像机图像以及激光测距传感器的测距信息,将旋翼无人机悬停于火点上方;
步骤2.2),根据接收到的第二GPS模块感应到的GPS坐标信息,操作人员通过远程监控终端无线控制智能消防机器人运动到距离火点预设的距离阈值处;
地面控制模块记录下此时第一GPS模块感应到的GPS坐标和消防水炮的航向角θ1,将此时第一GPS模块感应到的GPS坐标作为M坐标系的原点O(0,0),并以正东为M坐标系X轴的正方向,正北为M坐标系Y轴的正方向;
步骤2.3),地面控制模块发送火点跟踪指令给所述机载控制模块,机载控制模块接收到火点跟踪指令后,控制机载云台使火点中心处于热像仪图像中心,并将第二GPS模块感应到的GPS坐标、机载云台的航向角α1、机载云台的俯仰角β1、激光测距传感器测得的距离L1通过第二无线通讯模块发送给地面控制模块;
步骤2.4),地面控制模块将接收到的无人机第二GPS模块感应到的GPS坐标转化为M坐标系下的坐标,记为A(X0,Y0),再根据事故地区地球真北与磁北的偏角ψ,求得火点中心在M坐标系下的坐标为B(X1,Y1),计算公式如下:
根据以下公式求得火点中心到智能消防机器人的直线距离S1:
根据以下公式计算出火点的航向角,即OB直线的航向角为σ1:
步骤2.5),地面控制模块控制消防水炮水平转动,直至其航向角为σ1,使消防水炮在水平方向对准着火点,然后根据距离S1调整消防水炮的俯仰角和喷射流量后,控制消防水炮进行喷射,并发送射流落点跟踪指令给所述机载控制模块;
步骤2.6),机载控制模块接收到射流落点跟踪指令后,控制机载云台使射流落点处于热像仪图像中心,并将此时机载云台的航向角α2、机载云台的俯仰角β2、激光测距传感器测得的距离L2通过第二无线通讯模块发送给地面控制模块;
步骤2.7),地面控制模块按照以下公式计算得到射流落点在M坐标系的坐标为C(X2,Y2):
然后按照以下公式计算得到射流落点的航向角,即直线OC的航向角为σ2:
步骤2.8),智能消防机器人的地面控制模块根据落点坐标C(X2,Y2)和σ2,控制消防水炮首先调整水平角度,直至σ2=σ1,然后控制消防水炮俯仰角使射流落点的坐标和B重合;
步骤2.9),重复步骤2.3)至步骤2.9),直至火点被扑灭。
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.基于无人机和智能消防机器人的精确灭火***,其特征在于,包括智能消防机器人、旋翼无人机和远程监控终端;
所述智能消防机器人包含机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、地面控制模块、第一航姿传感器和无人机起落平台;
所述机器人本体用于根据地面控制模块的指令运动到指定地点;
所述消防水炮设置在所述机器人本体上,用于根据地面控制模块的指令调整其航向角和俯仰角、以及喷射或停止喷射;
所述第一航姿传感器设置在所述消防水炮上,用于感应消防水炮航向角和俯仰角,并将其传递给所述地面控制模块;
所述第一GPS模块用于感应所述机器人本体的GPS坐标,并将其传递给所述地面控制模块;
所述第一无线通讯模块用于和所述旋翼无人机、远程监控终端进行通讯;
所述无人机起落平台包含直流电磁吸盘和电磁吸盘保护壳,所述电磁吸盘保护壳将直流电磁吸盘包含在其中;所述直流电磁吸盘用于在通电时产生吸力使得所述旋翼无人机安稳的停靠在电磁吸盘保护壳上、在断电时松开所述旋翼无人机;
所述地面控制模块分别和所述机器人本体、消防水炮、第一GPS模块、第一无线通讯模块、第一航姿传感器、直流电磁吸盘电气相连;
所述旋翼无人机包含无人机本体、机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块、机载控制模块和旋翼无人机支撑架;
所述无人机本体用于根据机载控制模块进行飞行和降落;
所述第二GPS模块用于感应所述无人机本体的GPS坐标,并将其传递给所述机载控制模块;
所述机载云台设置在所述无人机上,用于搭载所述第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器,并根据机载控制模块的指令进行水平和垂直转动;
所述第二航姿传感器用于感应所述机载云台航向角和俯仰角,并将其传递给所述机载控制模块;
所述双波段可见光摄像机用于拍摄实时画面,并将其传递给所述机载控制模块;
所述红外热像仪用于火点、射流轨迹及落点的识别,并将识别信息传递给所述机载控制模块;
所述激光测距传感器用于感应火点和射流落点的距离,并将其传递给所述机载控制模块;
所述第二通讯模块用于和所述第一无线通讯模块、远程监控终端进行通讯;
所述旋翼无人机支撑架设置在所述无人机本体上,其外设有磁性物质层,用于无人机本体停靠在所述无人机起落平台;
所述机载控制模块分别和所述机载云台、第二GPS模块、第二航姿传感器、双波段可见光摄像机、红外热像仪、激光测距传感器、第二无线通讯模块电气相连;
所述远程监控终端用于远程控制所述远程监控终端和智能消防机器人。
2.根据权利要求1所述的基于无人机和智能消防机器人的精确灭火***的灭火方法,其特征在于,包含如下步骤:
步骤2.1),到达事故现场后,首先由操作人员控制通过远程监控终端控制旋翼无人机从智能消防机器人的起落平台起飞,进行火点的搜寻,搜寻到火点后,操作人员根据第二无线通讯模块回传的热像仪、双波段可见光摄像机图像以及激光测距传感器的测距信息,将旋翼无人机悬停于火点上方;
步骤2.2),根据接收到的第二GPS模块感应到的GPS坐标信息,操作人员通过远程监控终端无线控制智能消防机器人运动到距离火点预设的距离阈值处;
地面控制模块记录下此时第一GPS模块感应到的GPS坐标和消防水炮的航向角θ1,将此时第一GPS模块感应到的GPS坐标作为M坐标系的原点O(0,0),并以正东为M坐标系X轴的正方向,正北为M坐标系Y轴的正方向;
步骤2.3),地面控制模块发送火点跟踪指令给所述机载控制模块,机载控制模块接收到火点跟踪指令后,控制机载云台使火点中心处于热像仪图像中心,并将第二GPS模块感应到的GPS坐标、机载云台的航向角α1、机载云台的俯仰角β1、激光测距传感器测得的距离L1通过第二无线通讯模块发送给地面控制模块;
步骤2.4),地面控制模块将接收到的无人机第二GPS模块感应到的GPS坐标转化为M坐标系下的坐标,记为A(X0,Y0),再根据事故地区地球真北与磁北的偏角ψ,求得火点中心在M坐标系下的坐标为B(X1,Y1),计算公式如下:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mi>X</mi>
<mn>1</mn>
<mo>=</mo>
<mi>X</mi>
<mn>0</mn>
<mo>+</mo>
<mi>L</mi>
<mn>1</mn>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mn>1</mn>
<mo>+</mo>
<mi>&psi;</mi>
<mo>)</mo>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>Y</mi>
<mn>1</mn>
<mo>=</mo>
<mi>Y</mi>
<mn>0</mn>
<mo>+</mo>
<mi>L</mi>
<mn>1</mn>
<mo>&times;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mn>1</mn>
<mo>+</mo>
<mi>&psi;</mi>
<mo>)</mo>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
根据以下公式求得火点中心到智能消防机器人的直线距离S1:
<mrow>
<mi>S</mi>
<mn>1</mn>
<mo>=</mo>
<msqrt>
<mrow>
<mi>X</mi>
<msup>
<mn>1</mn>
<mn>2</mn>
</msup>
<mo>+</mo>
<mi>Y</mi>
<msup>
<mn>1</mn>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
根据以下公式计算出火点的航向角,即OB直线的航向角为σ1:
步骤2.5),地面控制模块控制消防水炮水平转动,直至其航向角为σ1,使消防水炮在水平方向对准着火点,然后根据距离S1调整消防水炮的俯仰角和喷射流量后,控制消防水炮进行喷射,并发送射流落点跟踪指令给所述机载控制模块;
步骤2.6),机载控制模块接收到射流落点跟踪指令后,控制机载云台使射流落点处于热像仪图像中心,并将此时机载云台的航向角α2、机载云台的俯仰角β2、激光测距传感器测得的距离L2通过第二无线通讯模块发送给地面控制模块;
步骤2.7),地面控制模块按照以下公式计算得到射流落点在M坐标系的坐标为C(X2,Y2):
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mi>X</mi>
<mn>2</mn>
<mo>=</mo>
<mi>X</mi>
<mn>0</mn>
<mo>+</mo>
<mi>L</mi>
<mn>2</mn>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mn>2</mn>
<mo>+</mo>
<mi>&psi;</mi>
<mo>)</mo>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mn>2</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>Y</mi>
<mn>2</mn>
<mo>=</mo>
<mi>Y</mi>
<mn>0</mn>
<mo>+</mo>
<mi>L</mi>
<mn>2</mn>
<mo>&times;</mo>
<mi>cos</mi>
<mo>(</mo>
<mi>&alpha;</mi>
<mn>2</mn>
<mo>+</mo>
<mi>&psi;</mi>
<mo>)</mo>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&beta;</mi>
<mn>2</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
然后按照以下公式计算得到射流落点的航向角,即直线OC的航向角为σ2:
步骤2.8),智能消防机器人的地面控制模块根据落点坐标C(X2,Y2)和σ2,控制消防水炮首先调整水平角度,直至σ2=σ1,然后控制消防水炮俯仰角使射流落点的坐标和B重合;
步骤2.9),重复步骤2.3)至步骤2.9),直至火点被扑灭。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711283478.XA CN107899166B (zh) | 2017-12-07 | 2017-12-07 | 基于无人机和智能消防机器人的精确灭火***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711283478.XA CN107899166B (zh) | 2017-12-07 | 2017-12-07 | 基于无人机和智能消防机器人的精确灭火***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107899166A true CN107899166A (zh) | 2018-04-13 |
CN107899166B CN107899166B (zh) | 2022-10-21 |
Family
ID=61864871
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711283478.XA Active CN107899166B (zh) | 2017-12-07 | 2017-12-07 | 基于无人机和智能消防机器人的精确灭火***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107899166B (zh) |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108714279A (zh) * | 2018-05-25 | 2018-10-30 | 深圳市华讯方舟装备技术有限公司 | 一种基于水上自动驾驶的消防船艇的灭火方法、装置、***以及一种存储介质 |
CN109157782A (zh) * | 2018-07-26 | 2019-01-08 | 长沙中联消防机械有限公司 | 一种举高消防车灭火***、方法以及举高消防车 |
CN109276831A (zh) * | 2018-07-26 | 2019-01-29 | 长沙中联消防机械有限公司 | 举高消防车灭火***、方法以及举高消防车 |
CN110075462A (zh) * | 2019-05-14 | 2019-08-02 | 中国科学院自动化研究所 | 消防*** |
CN110115817A (zh) * | 2019-05-08 | 2019-08-13 | 昆明理工大学 | 一种陆空森林消防机器人 |
CN110180112A (zh) * | 2019-06-05 | 2019-08-30 | 山东国兴智能科技股份有限公司 | 一种无人机与消防机器人协同侦察灭火作业方法 |
CN110245569A (zh) * | 2019-05-17 | 2019-09-17 | 武汉科技大学 | 基于射流边缘分析和打击偏差反馈的船舶打击效果评估方法 |
CN110263710A (zh) * | 2019-06-20 | 2019-09-20 | 湘潭大学 | 一种基于地空协作的灭火装置、方法及*** |
CN110339513A (zh) * | 2019-07-17 | 2019-10-18 | 苏州力佳达电子科技有限公司 | 一种具有火灾初期可自动灭火及报警功能的机器人 |
CN110354424A (zh) * | 2019-07-19 | 2019-10-22 | 江苏科达机械有限公司 | 一种消防装置 |
CN110634260A (zh) * | 2019-10-10 | 2019-12-31 | 普宙飞行器科技(深圳)有限公司 | 烟火检测设备、无人机***以及烟火检测方法 |
CN110726407A (zh) * | 2019-12-18 | 2020-01-24 | 深圳光启空间技术有限公司 | 一种定位监控方法及装置 |
EP3731198A1 (de) * | 2019-04-24 | 2020-10-28 | Minimax Viking Research & Development GmbH | Brandschutzroboter zur steuerung von brandbekämpfungsvorrichtungen, entsprechendes brandschutzsystem und verfahren zum betrieb desselben |
CN112066994A (zh) * | 2020-09-28 | 2020-12-11 | 河海大学常州校区 | 一种消防机器人局部自主导航方法及*** |
CN112138314A (zh) * | 2020-09-25 | 2020-12-29 | 南京工程学院 | 人工智能灭火机器人 |
CN112316340A (zh) * | 2020-11-26 | 2021-02-05 | 浙江理工大学 | 地面灭火机器人及其控制方法、空地联动式灭火***及其控制方法 |
CN112774073A (zh) * | 2021-02-05 | 2021-05-11 | 燕山大学 | 无人机引导的多机协作灭火方法及其灭火*** |
CN113274663A (zh) * | 2021-06-10 | 2021-08-20 | 广州亿航智能技术有限公司 | 一种消防型无人机的控制方法、装置和计算设备 |
CN114010998A (zh) * | 2021-10-27 | 2022-02-08 | 镇江同舟螺旋桨有限公司 | 一种基于远程遥控的自行走灭火机器人 |
CN114307016A (zh) * | 2021-11-22 | 2022-04-12 | 中国矿业大学 | 一种基于无人机视觉辅助消防炮灭火***及控制方法 |
CN114452576A (zh) * | 2021-12-14 | 2022-05-10 | 武汉船用电力推进装置研究所(中国船舶重工集团公司第七一二研究所) | 一种电动水炮及其控制方法 |
CN115671617A (zh) * | 2022-11-03 | 2023-02-03 | 国网冀北电力有限公司超高压分公司 | 柔直换流站火灾定位方法、装置、设备及存储介质 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050189122A1 (en) * | 2004-02-06 | 2005-09-01 | Eads Deutschland Gmbh | Method for detecting and combating forest and surface fires |
KR101073076B1 (ko) * | 2011-06-10 | 2011-10-12 | 주식회사 창성에이스산업 | 복합카메라를 이용한 화재감시 시스템 및 방법 |
US20130134254A1 (en) * | 2011-11-29 | 2013-05-30 | Jason Moore | UAV Fire-fighting System |
CN105031857A (zh) * | 2015-08-19 | 2015-11-11 | 山推抚起机械有限公司 | 一种新型履带式消防车 |
CN105396251A (zh) * | 2015-10-16 | 2016-03-16 | 南京航空航天大学 | 一种机器人辅助下的立体智能消防*** |
CN105775112A (zh) * | 2016-03-21 | 2016-07-20 | 安徽钰龙信息科技有限公司 | 一种四轴无人机起降装置 |
CN205554015U (zh) * | 2016-04-13 | 2016-09-07 | 上海优伟斯智能***有限公司 | 一种无人机gcs通信指挥车 |
CN106861100A (zh) * | 2017-03-17 | 2017-06-20 | 大连希尔德安全技术有限公司 | 基于全景摄像头的火灾探测、定位和扑灭方法及装置 |
CN107007957A (zh) * | 2017-04-28 | 2017-08-04 | 苏州商信宝信息科技有限公司 | 一种带有无人机的智能消防机器人及其控制方法 |
CN107029374A (zh) * | 2017-04-28 | 2017-08-11 | 成都谍翼科技有限公司 | 集群控制消防方法及装置 |
CN207950388U (zh) * | 2017-12-07 | 2018-10-12 | 南京航空航天大学 | 基于无人机和智能消防机器人的精确灭火*** |
-
2017
- 2017-12-07 CN CN201711283478.XA patent/CN107899166B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050189122A1 (en) * | 2004-02-06 | 2005-09-01 | Eads Deutschland Gmbh | Method for detecting and combating forest and surface fires |
KR101073076B1 (ko) * | 2011-06-10 | 2011-10-12 | 주식회사 창성에이스산업 | 복합카메라를 이용한 화재감시 시스템 및 방법 |
US20130134254A1 (en) * | 2011-11-29 | 2013-05-30 | Jason Moore | UAV Fire-fighting System |
CN105031857A (zh) * | 2015-08-19 | 2015-11-11 | 山推抚起机械有限公司 | 一种新型履带式消防车 |
CN105396251A (zh) * | 2015-10-16 | 2016-03-16 | 南京航空航天大学 | 一种机器人辅助下的立体智能消防*** |
CN105775112A (zh) * | 2016-03-21 | 2016-07-20 | 安徽钰龙信息科技有限公司 | 一种四轴无人机起降装置 |
CN205554015U (zh) * | 2016-04-13 | 2016-09-07 | 上海优伟斯智能***有限公司 | 一种无人机gcs通信指挥车 |
CN106861100A (zh) * | 2017-03-17 | 2017-06-20 | 大连希尔德安全技术有限公司 | 基于全景摄像头的火灾探测、定位和扑灭方法及装置 |
CN107007957A (zh) * | 2017-04-28 | 2017-08-04 | 苏州商信宝信息科技有限公司 | 一种带有无人机的智能消防机器人及其控制方法 |
CN107029374A (zh) * | 2017-04-28 | 2017-08-11 | 成都谍翼科技有限公司 | 集群控制消防方法及装置 |
CN207950388U (zh) * | 2017-12-07 | 2018-10-12 | 南京航空航天大学 | 基于无人机和智能消防机器人的精确灭火*** |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108714279A (zh) * | 2018-05-25 | 2018-10-30 | 深圳市华讯方舟装备技术有限公司 | 一种基于水上自动驾驶的消防船艇的灭火方法、装置、***以及一种存储介质 |
CN109157782A (zh) * | 2018-07-26 | 2019-01-08 | 长沙中联消防机械有限公司 | 一种举高消防车灭火***、方法以及举高消防车 |
CN109276831A (zh) * | 2018-07-26 | 2019-01-29 | 长沙中联消防机械有限公司 | 举高消防车灭火***、方法以及举高消防车 |
CN109157782B (zh) * | 2018-07-26 | 2021-03-19 | 长沙中联消防机械有限公司 | 一种举高消防车灭火***、方法以及举高消防车 |
EP3731198A1 (de) * | 2019-04-24 | 2020-10-28 | Minimax Viking Research & Development GmbH | Brandschutzroboter zur steuerung von brandbekämpfungsvorrichtungen, entsprechendes brandschutzsystem und verfahren zum betrieb desselben |
CN110115817A (zh) * | 2019-05-08 | 2019-08-13 | 昆明理工大学 | 一种陆空森林消防机器人 |
CN110075462A (zh) * | 2019-05-14 | 2019-08-02 | 中国科学院自动化研究所 | 消防*** |
CN110245569A (zh) * | 2019-05-17 | 2019-09-17 | 武汉科技大学 | 基于射流边缘分析和打击偏差反馈的船舶打击效果评估方法 |
CN110245569B (zh) * | 2019-05-17 | 2021-04-20 | 武汉科技大学 | 基于射流边缘分析和打击偏差反馈的船舶打击效果评估方法 |
CN110180112B (zh) * | 2019-06-05 | 2020-11-13 | 山东国兴智能科技股份有限公司 | 一种无人机与消防机器人协同侦察灭火作业方法 |
CN110180112A (zh) * | 2019-06-05 | 2019-08-30 | 山东国兴智能科技股份有限公司 | 一种无人机与消防机器人协同侦察灭火作业方法 |
CN110263710B (zh) * | 2019-06-20 | 2021-05-11 | 湘潭大学 | 一种基于地空协作的灭火方法及*** |
CN110263710A (zh) * | 2019-06-20 | 2019-09-20 | 湘潭大学 | 一种基于地空协作的灭火装置、方法及*** |
CN110339513A (zh) * | 2019-07-17 | 2019-10-18 | 苏州力佳达电子科技有限公司 | 一种具有火灾初期可自动灭火及报警功能的机器人 |
CN110354424A (zh) * | 2019-07-19 | 2019-10-22 | 江苏科达机械有限公司 | 一种消防装置 |
CN110634260A (zh) * | 2019-10-10 | 2019-12-31 | 普宙飞行器科技(深圳)有限公司 | 烟火检测设备、无人机***以及烟火检测方法 |
CN110726407A (zh) * | 2019-12-18 | 2020-01-24 | 深圳光启空间技术有限公司 | 一种定位监控方法及装置 |
CN112138314A (zh) * | 2020-09-25 | 2020-12-29 | 南京工程学院 | 人工智能灭火机器人 |
CN112066994A (zh) * | 2020-09-28 | 2020-12-11 | 河海大学常州校区 | 一种消防机器人局部自主导航方法及*** |
CN112066994B (zh) * | 2020-09-28 | 2022-07-22 | 河海大学常州校区 | 一种消防机器人局部自主导航方法及*** |
CN112316340A (zh) * | 2020-11-26 | 2021-02-05 | 浙江理工大学 | 地面灭火机器人及其控制方法、空地联动式灭火***及其控制方法 |
CN112774073A (zh) * | 2021-02-05 | 2021-05-11 | 燕山大学 | 无人机引导的多机协作灭火方法及其灭火*** |
CN113274663A (zh) * | 2021-06-10 | 2021-08-20 | 广州亿航智能技术有限公司 | 一种消防型无人机的控制方法、装置和计算设备 |
CN114010998A (zh) * | 2021-10-27 | 2022-02-08 | 镇江同舟螺旋桨有限公司 | 一种基于远程遥控的自行走灭火机器人 |
CN114307016A (zh) * | 2021-11-22 | 2022-04-12 | 中国矿业大学 | 一种基于无人机视觉辅助消防炮灭火***及控制方法 |
CN114452576A (zh) * | 2021-12-14 | 2022-05-10 | 武汉船用电力推进装置研究所(中国船舶重工集团公司第七一二研究所) | 一种电动水炮及其控制方法 |
CN115671617A (zh) * | 2022-11-03 | 2023-02-03 | 国网冀北电力有限公司超高压分公司 | 柔直换流站火灾定位方法、装置、设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107899166B (zh) | 2022-10-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107899166A (zh) | 基于无人机和智能消防机器人的精确灭火***及方法 | |
CN207950388U (zh) | 基于无人机和智能消防机器人的精确灭火*** | |
CN104298248B (zh) | 旋翼无人机精确视觉定位定向方法 | |
US11378458B2 (en) | Airborne inspection systems and methods | |
CN106873627B (zh) | 一种自动巡检输电线路的多旋翼无人机及方法 | |
García Carrillo et al. | Stabilization and trajectory tracking of a quad-rotor using vision | |
CN108306217A (zh) | 一种架空高压线智能自主沿导线飞行巡检***和方法 | |
CN104571140B (zh) | 一种光伏组件巡检拍照控制*** | |
EP2724204B1 (en) | Method for acquiring images from arbitrary perspectives with uavs equipped with fixed imagers | |
CN107247458A (zh) | 无人机视频图像目标定位***、定位方法及云台控制方法 | |
CN109911188A (zh) | 非卫星导航定位环境的桥梁检测无人机*** | |
CN109901580A (zh) | 一种无人机与无人地面机器人协作循径避障***及其方法 | |
CN101968913B (zh) | 一种森林火灾区域的火焰跟踪方法 | |
CN109753076A (zh) | 一种无人机视觉追踪实现方法 | |
CN105790155A (zh) | 一种基于差分gps的输电线路无人机自主巡检***及方法 | |
CN106527470A (zh) | 一种精准导航变电站巡检无人机*** | |
CN105182992A (zh) | 无人机的控制方法、装置 | |
CN102190081B (zh) | 基于视觉的飞艇定点鲁棒控制方法 | |
CN110333735B (zh) | 一种实现无人机水陆二次定位的***和方法 | |
CN109683629A (zh) | 基于组合导航和计算机视觉的无人机电力架线*** | |
CN111123973A (zh) | 一种无人机线路杆塔巡视引导***及引导方法 | |
CN112486199A (zh) | 一种适用于偏远输电塔群无人机巡检控制***及巡检方法 | |
CN109597432B (zh) | 一种基于车载摄像机组的无人机起降监控方法及*** | |
CN110624189B (zh) | 无人机机载灭火弹装置、消防无人机以及发射控制方法 | |
CN106444792A (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 |