CN103217985A - 基于双飞行机器人对有源目标的协调搜寻方法与*** - Google Patents

基于双飞行机器人对有源目标的协调搜寻方法与*** Download PDF

Info

Publication number
CN103217985A
CN103217985A CN2012104249813A CN201210424981A CN103217985A CN 103217985 A CN103217985 A CN 103217985A CN 2012104249813 A CN2012104249813 A CN 2012104249813A CN 201210424981 A CN201210424981 A CN 201210424981A CN 103217985 A CN103217985 A CN 103217985A
Authority
CN
China
Prior art keywords
aircraft
search
constantly
alternative way
searching
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
Application number
CN2012104249813A
Other languages
English (en)
Other versions
CN103217985B (zh
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.)
Jinghai Intelligent Equipment Co ltd
Original Assignee
University of Shanghai for Science and Technology
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 University of Shanghai for Science and Technology filed Critical University of Shanghai for Science and Technology
Priority to CN201210424981.3A priority Critical patent/CN103217985B/zh
Publication of CN103217985A publication Critical patent/CN103217985A/zh
Application granted granted Critical
Publication of CN103217985B publication Critical patent/CN103217985B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种基于无人飞行机器人对有源目标的协调搜寻方法及***。本方法对目标所在的搜寻区域进行搜索地图建模,即在二维空间内进行离散化,并基于该地图模型提出路径规划方法,从而构建导航成本函数,以规划飞行器机器人的飞行轨迹,实现低成本高效率的协调搜寻。本***是在两无人飞行机器人上安装GPS定位仪,无线通讯设备、信号测向仪、飞行控制设备和主控单元,飞行机器人在搜寻过程中实时通讯,共享地图和目标信息。本发明可用于对区域内各种带辐射源目标的搜寻和探测,采用双飞行机器人进行自动协调搜寻,实现快速有效的发现有源目标,能够对区域目标进行快速高效的搜寻。

Description

基于双飞行机器人对有源目标的协调搜寻方法与***
技术领域
本发明涉及一种基于无人飞行机器人在特定区域内的协调搜寻方法及***,特别是基于双飞行机器人对有源目标的协调搜寻方法与***,用于对区域内各种带辐射源目标的搜寻和探测,采用双飞行机器人进行自动协调搜寻,实现快速有效的发现有源目标。 
背景技术
近年来,世界各地灾难频发,严重威胁人类的生存和发展。灾后发现搜救目标,实施快速救援,能够大大提高失踪人员生还的可能性,减少生命财产的损失。传统的搜寻方法一般采用地面、空中(载人直升机)两支搜救队伍展开搜寻。然而,由于失踪目标所处区域的特殊性(如山区、海洋、沼泽地带等),传统的搜寻方法不仅效率低,而且存在搜寻人员的生命安全问题。因此,迫切需要一种更好的搜寻方法。 
采用无人驾驶飞行机器人(以下简称无人机)对目标进行搜寻是现代搜救领域的发展方向之一。无人机能从多种平台(如车辆、舰船、航空器、亚轨道飞行器和卫星等)发射和回收,搜寻机动性较传统方法大大提高。此外,无人机还具有体积小,成本低,无人员伤亡风险,生存能力强等优点,在各领域都具有广阔的应用前景。采用多无人机对区域进行协调搜寻,不但具有单架无人机的所有特点,还有其自身独特的优势,如目标搜寻效率高,定位精度高,搜寻范围大等。 
根据以上背景技术的分析,采用飞行机器人对特定区域的目标进行协调搜寻,是一个高效、安全、低成本的方法。 
发明内容
       本发明的目的在于针对现有搜寻技术存在的不足,提出一种基于双飞行机器人对有源目标的协调搜寻方法与***。该能够在特定大小的区域内引导无人飞行机器人自动对有源目标进行协调搜寻,搜寻效率高,成本低,风险小。 
       本发明的构思在于:传统的搜寻方法采用地面基站和空中在人飞行器结合的方法搜寻目标,这样不仅成本高,在某些危险的场合还可能存在搜救人员和搜救设备的危险性。而传统的无人飞行器搜寻多是基于各个机体直接对目标进行搜寻和探测,各自搜索独立的区域,不存在协同性,因此效率较低,存在资源浪费和成本过高的缺陷。因此,为了克服已有的搜寻方法的局限性和不足,本发明提出了基于双无人驾驶机器人的协调搜寻方法,对搜寻区域进行协调搜索,实现短时间内的覆盖面最大化,以提高目标搜寻效率。同时,由于采用小型无人飞行器,具有成本低,机动性高,风险低等优点。 
       在搜寻***中,搜寻主题是两架旋翼飞行机器人,每架飞行机器人通过机载主控制***进行主控。主控模块通过采集机载 GPS 全球定位***的信号进行定位和导航,无人飞行器之间通过机载无线通讯模块进行通讯和数据共享。飞行器搭载信号接收测向设备,能够接受有源目标的信号并给出测向数据。 
       本发明中,我们对目标所在的搜寻区域进行搜索地图建模,即在二维空间内进行离散化。通过划分搜寻区域为若干个同样大小的正方形区域(S×S),如图1所示。无人飞行器在一个时间步长内可以从一个矩形中心以一定的路径飞行到邻近的矩形中心。通过这样的建模,可以实现: 
1)  飞行器的飞行航路点就可以转化为一系列正方形区域的中心坐标值,便于数值化计算和共享。同样地,飞行器的飞行轨迹就可以转化为一系列正方形区域的中心的连线。
2)  通过对各个正方形区域进行赋值标定,能够对搜索地图进行信息构建和共享。在本发明中,对被任一飞行器搜寻过的正方形区域赋值1,未被搜寻过的赋值0。这样就构建地图搜寻历史信息,飞行器通过我们设计的算法,尽可能搜寻未被搜寻过的区域,从而避免重复搜索,提高效率。 
在搜寻过程中,飞行器应对尽可能在最短的时间内覆盖最多的搜寻区域,以尽快发现目标。同时,飞行器又不能飞出搜寻边界。因此,飞行器应当尽可能远离友机以及搜寻边界,避免重复搜索和越出边界。为此,本发明设计了基于上述离散化地图模型的导航成本函数,用于协调飞行器的飞行轨迹。该函数融合了各飞行器当前位置、下一时刻位置和搜寻区域边界等信息,飞行器通过评价该函数值得大小来规划各自飞行的轨迹。 
根据上述发明构思,本发明采用下述技术方案: 
一种基于双飞行机器人对有源目标的协调搜寻方法,其特征在于操作步骤如下:
1)对目标所在的搜寻区域进行搜索地图建模:在二维空间内进行离散化,搜寻区域为大小X×Y的矩形区域,划分搜寻区域为若干个同样大小的正方形区域(S×S),所有正方形区域的搜寻标记值H初始化为0,无人飞行器在一个时间步长内从一个矩形中心飞行到邻近的矩形中心;
2)双飞行器在任一正方形区域内,根据当前的航向,均产生3个备选航路点,即:左前方、正前方、右前方;并通过机载通讯设备与友机共享该信息;
3)根据导航成本函数 
Figure 585755DEST_PATH_IMAGE001
,其中
Figure 109140DEST_PATH_IMAGE002
为双飞行器之间的距离,
Figure 601302DEST_PATH_IMAGE003
为双飞行器到搜寻区域边界的距离,确定双飞行器各自下一时刻的目标位置;双飞行器移动到目标位置;
4)更新地图信息,将当前搜寻的正方形区域标记为已搜寻,即赋值搜寻标记值H=1,搜寻标记值H初始值均为0;
5)根据双飞行器新的位置和航向,确定下一时刻的三个备选航路点;
6)不断重复步骤2)、3)、4)、5),直到发现目标。
上述步骤3)中的确定双飞行器下一时刻目标位置的方法是:根据权利要求1所述的基于双飞行机器人对有源目标的协调搜寻方法,其特征在于所述步骤3)中的确定双飞行器各自下一时刻目标位置的方法: 
双飞行器根据导航成本函数从各自三个备选航路点中选择最优点作为目标位置。
设双飞行器为
Figure DEST_PATH_RE-931100DEST_PATH_IMAGE005
Figure DEST_PATH_RE-574571DEST_PATH_IMAGE006
,成本函数工作原理中的标注符号说明如下:
Figure DEST_PATH_RE-972054DEST_PATH_IMAGE002
为双飞行器之间的距离,
Figure DEST_PATH_RE-700976DEST_PATH_IMAGE003
为双飞行器到搜寻区域边界的距离;
Figure DEST_PATH_RE-779790DEST_PATH_IMAGE007
表示飞行器
Figure DEST_PATH_RE-277768DEST_PATH_IMAGE005
Figure DEST_PATH_RE-360999DEST_PATH_IMAGE008
时刻的备选航路点1的坐标,
Figure DEST_PATH_RE-311637DEST_PATH_IMAGE009
表示飞行器
Figure DEST_PATH_RE-194143DEST_PATH_IMAGE005
Figure DEST_PATH_RE-546627DEST_PATH_IMAGE008
时刻的备选航路点2的坐标,表示飞行器
Figure DEST_PATH_RE-989426DEST_PATH_IMAGE005
Figure DEST_PATH_RE-410043DEST_PATH_IMAGE008
时刻的备选航路点3的坐标;同理,
Figure DEST_PATH_RE-882613DEST_PATH_IMAGE011
表示飞行器
Figure DEST_PATH_RE-809112DEST_PATH_IMAGE006
Figure DEST_PATH_RE-734343DEST_PATH_IMAGE008
时刻的备选航路点1的坐标,
Figure DEST_PATH_RE-958651DEST_PATH_IMAGE012
表示飞行器
Figure DEST_PATH_RE-366815DEST_PATH_IMAGE008
时刻的备选航路点2的坐标,
Figure DEST_PATH_RE-779342DEST_PATH_IMAGE013
表示飞行器
Figure DEST_PATH_RE-807341DEST_PATH_IMAGE006
Figure DEST_PATH_RE-988923DEST_PATH_IMAGE008
时刻的备选航路点3的坐标;以此标注方法类推,坐标中
Figure DEST_PATH_RE-178596DEST_PATH_IMAGE014
的上标第一项表示飞行器名称,上标第二项表示搜寻的时刻,下标表示下一时刻备选航路点的序号,即符号i;以飞行器为例,说明导航成本的工作原理:飞行器A 1根据当前位置当前时刻(t=0)
Figure DEST_PATH_RE-618357DEST_PATH_IMAGE017
及当前航向,产生一个时间步长后(即下一时刻t=1)的3个备选航路点:
Figure DEST_PATH_RE-437594DEST_PATH_IMAGE019
。同理,飞行器A 2也用该规则产生3个备选航路点:
Figure DEST_PATH_RE-125244DEST_PATH_IMAGE021
Figure DEST_PATH_RE-547130DEST_PATH_IMAGE022
Figure DEST_PATH_RE-720622DEST_PATH_IMAGE023
。飞行器A 1的三个备选航路点分别依次与飞行器A 2的三个备选航路点之间产生9个S i ,作为备选;同时,A 1的三个备选航路点
Figure DEST_PATH_RE-699259DEST_PATH_IMAGE025
Figure DEST_PATH_RE-857708DEST_PATH_IMAGE026
产生3个S j ,作为备选。将这些备选值一一代入
Figure DEST_PATH_RE-569312DEST_PATH_IMAGE027
,取该函数最小值的备选航点作为A 1下一时刻的航路点。 
       同理,飞行器
Figure 434500DEST_PATH_IMAGE006
可得下一时刻的航路点。 
一种基于双飞行机器人对有源目标的协调搜寻***,应用于上述定位方法,包括两个无人飞行机器人,每个无人飞行机器人上各装有GPS定位仪,无线通讯设备、信号测向仪、飞行控制***、主控单元。所述信号测向仪与主控单元通过RS-232与串口连接,进行测向信号传输;飞行控制***与主控单元CAN总线连接,实时传输导航飞行控制信息;GPS定位仪通过RS-232串口与主控单元连接,向主控单元传输无人飞行机器人的位置信息;无线通讯设备与主控单元通过RS-232串口连接,实现与友机之间实时通讯交互。其特征在于,飞行器通过无线通讯设备与友机进行通讯,将各自的航路点信息与更新的地图信息发送给友机,同时从友机接受信息。 
本发明与现有技术相比较具有如下显而易见的突出实质性特点和显著技术进步:本发明采用的双无人飞行机器人,能够在各种天气情况下进行独立飞行搜寻任务,减少了有人搜寻所带来的高成本及各种未知的风险性,同时,应用本发明提出的协调搜寻方法,双飞行机器人能够在较短的时间之内完成目标的搜寻,能够最大程度的提升搜寻的效率、安全性和可靠性。同时,该方法为未来各种遗失目标的搜寻提供了技术上的支撑。正是由于飞行机器人体积小、携带方便,成本低的特点,随着该项技术的逐渐成熟,这方面潜在的应用前景也是十分广阔的。 
附图说明
图1是搜寻区域地图模型; 
图2是无人飞行机器人路径产生和选择示意图;
图3为无人飞行机器导航成本的工作原理图。
具体实施方式
本发明的优选实施例结合附图说明如下: 
    实施例一:
本基于双飞行机器人对有源目标的协调搜寻方法,其特征在于操作步骤如下:
1)对目标所在的搜寻区域进行搜索地图建模:在二维空间内进行离散化,搜寻区域为大小X×Y的矩形区域,划分搜寻区域为若干个同样大小的正方形区域(S×S),所有正方形区域的搜寻标记值H初始化为0,无人飞行器在一个时间步长内从一个矩形中心飞行到邻近的矩形中心;
2)双飞行器在任一正方形区域内,根据当前的航向,均产生3个备选航路点,即:左前方、正前方、右前方;并通过机载通讯设备与友机共享该信息;
3)根据导航成本函数
Figure 573357DEST_PATH_IMAGE028
,其中
Figure 468370DEST_PATH_IMAGE002
为双飞行器之间的距离,
Figure 718086DEST_PATH_IMAGE003
为双飞行器到搜寻区域边界的距离,确定双飞行器各自下一时刻的目标位置;双飞行器移动到目标位置;
4)更新地图信息,将当前搜寻的正方形区域标记为已搜寻,即赋值搜寻标记值H=1,搜寻标记值H初始值均为0;
5)根据双飞行器新的位置和航向,确定下一时刻的三个备选航路点;
6)不断重复步骤2)、3)、4)、5),直到发现目标。
实施例二: 
本实施例与实施例一基本相同,特别之处如下:
参见图1和图2,上述步骤3)中的确定双飞行器下一时刻目标位置的方法是:根据权利要求1所述的基于双飞行机器人对有源目标的协调搜寻方法,其特征在于步骤3)中的确定双飞行器下一时刻目标位置的方法:
双飞行器根据导航成本函数
Figure 703359DEST_PATH_IMAGE029
从各自三个备选航路点中选择最优点作为目标位置。
设双飞行器为
Figure DEST_PATH_RE-13118DEST_PATH_IMAGE005
Figure DEST_PATH_RE-83842DEST_PATH_IMAGE006
,就本发明的成本函数工作原理中的标注符号说明如下:
Figure DEST_PATH_RE-199566DEST_PATH_IMAGE002
为双飞行器之间的距离,
Figure DEST_PATH_RE-39346DEST_PATH_IMAGE003
为双飞行器到搜寻区域边界的距离。
Figure DEST_PATH_RE-520006DEST_PATH_IMAGE030
表示飞行器时刻的备选航路点1的坐标,
Figure DEST_PATH_RE-176880DEST_PATH_IMAGE031
表示飞行器
Figure DEST_PATH_RE-828441DEST_PATH_IMAGE005
时刻的备选航路点2的坐标,表示飞行器
Figure DEST_PATH_RE-880077DEST_PATH_IMAGE005
Figure DEST_PATH_RE-968119DEST_PATH_IMAGE008
时刻的备选航路点3的坐标。同理,
Figure DEST_PATH_RE-235152DEST_PATH_IMAGE033
表示飞行器
Figure DEST_PATH_RE-745636DEST_PATH_IMAGE006
Figure DEST_PATH_RE-148936DEST_PATH_IMAGE008
时刻的备选航路点1的坐标,
Figure DEST_PATH_RE-407879DEST_PATH_IMAGE034
表示飞行器
Figure DEST_PATH_RE-162208DEST_PATH_IMAGE006
Figure DEST_PATH_RE-899220DEST_PATH_IMAGE008
时刻的备选航路点2的坐标,
Figure DEST_PATH_RE-484922DEST_PATH_IMAGE035
表示飞行器
Figure DEST_PATH_RE-914767DEST_PATH_IMAGE006
Figure DEST_PATH_RE-890813DEST_PATH_IMAGE008
时刻的备选航路点3的坐标。以此标注方法类推,坐标中
Figure DEST_PATH_RE-431516DEST_PATH_IMAGE014
的上标第一项表示飞行器名称,上标第二项表示搜寻的时刻,下标表示下一时刻备选航路点的序号,即图3中的符号i。以飞行器
Figure DEST_PATH_RE-223202DEST_PATH_IMAGE005
为例,结合图3说明导航成本的工作原理。 
飞行器A 1根据当前位置当前时刻(t=0)
Figure 30938DEST_PATH_IMAGE036
及当前航向,产生一个时间步长后(即下一时刻t=1)的3个备选航路点:
Figure 591233DEST_PATH_IMAGE030
Figure 313518DEST_PATH_IMAGE038
。同理,飞行器A 2也用该规则产生3个备选航路点:
Figure 196023DEST_PATH_IMAGE039
Figure 548507DEST_PATH_IMAGE040
Figure 802640DEST_PATH_IMAGE041
。飞行器A 1的三个备选航路点分别依次与飞行器A 2的三个备选航路点之间产生9个S i ,作为备选;同时,A 1的三个备选航路点
Figure 240575DEST_PATH_IMAGE042
Figure 661192DEST_PATH_IMAGE043
Figure 133761DEST_PATH_IMAGE044
产生3个S j ,作为备选。将这些备选值一一代入
Figure 43949DEST_PATH_IMAGE045
,取该函数最小值的备选航点作为A 1下一时刻的航路点。 
同理,飞行器
Figure 969179DEST_PATH_IMAGE006
可得下一时刻的航路点。 
实施例三: 
本基于双飞行机器人对有源目标的协调搜寻***,应用于上述方法,包括两个无人飞行机器人、每个无人飞行机器人上各装有GPS定位仪,无线通讯设备、信号测向仪、飞行控制***、主控单元;其中,GPS定位仪采集双飞行器的位置信息,以确定双飞行器的当前位置;无线通讯设备用于双飞行器之间的通信,以共享搜寻信息,其特征在于,飞行器通过无线通讯设备与友机进行通讯,将各自的航路点信息与更新的地图信息发送给友机,同时从友机接受信息;信号测向仪用于探测有源目标;飞行控制***用于控制飞行器的飞行状态;主控单元用于整个飞行器的全局控制;所述信号测向仪与主控单元通过RS-232与串口连接,进行测向信号传输;飞行控制***与主控单元CAN总线连接,实时传输导航飞行控制信息;GPS定位仪通过RS-232串口与主控单元连接,向主控单元传输无人飞行机器人的位置信息;无线通讯设备与主控单元通过RS-232串口连接,实现与友机进行通讯。
本***采用双飞行机器人是两架 SUAV-X160 型超小型无人旋翼机。GPS 定位仪采用 RGM3000 定位仪无线通讯设备采用 XStream  XH9-019PKC-R,机载的主控制单元采用 TMS320F2812 系列DSP芯片来实现对各个模块的控制,同时嵌入了定位算法及导航算法,目标为发射源目标。 
双飞行机器人协调搜寻方法如下: 
如图1所示,给定搜寻区域X×Y,并在二维平面进行划分,最小单元为正方形区域S×S。飞行器给定初始位置和初始航向,并根据本发明提出的协调路径规划方法给出3个备选航路点,通过评价成本函数来确定下一时刻的目标位置,并以一定的飞行轨迹到达,同时给出下一时刻的3个航路点,采用同样的方法确定目标位置,以此类推,直到发现区域内目标。 

Claims (3)

1.一种基于双飞行机器人对有源目标的协调搜寻方法,其特征在于操作步骤如下:
1)对目标所在的搜寻区域进行搜索地图建模:在二维空间内进行离散化,搜寻区域为大小X×Y的矩形区域,划分搜寻区域为若干个同样大小的正方形区域(S×S),所有正方形区域的搜寻标记值H初始化为0,无人飞行器在一个时间步长内从一个矩形中心飞行到邻近的矩形中心;
2)双飞行器在任一正方形区域内,根据当前的航向,均产生3个备选航路点,即:左前方、正前方、右前方;并通过机载通讯设备与友机共享该信息;
3)根据导航成本函数 
Figure 631785DEST_PATH_IMAGE002
,其中
Figure 916135DEST_PATH_IMAGE004
为双飞行器之间的距离,
Figure 266345DEST_PATH_IMAGE006
为双飞行器到搜寻区域边界的距离,确定双飞行器各自下一时刻的目标位置;双飞行器移动到目标位置;
4)更新地图信息,将当前搜寻的正方形区域标记为已搜寻,即赋值搜寻标记值H=1,搜寻标记值H初始值均为0;
5)根据双飞行器新的位置和航向,确定下一时刻的三个备选航路点;
6)不断重复步骤2)、3)、4)、5),直到发现目标。
2.根据权利要求1所述的基于双飞行机器人对有源目标的协调搜寻方法,其特征在于所述步骤3)中的确定双飞行器各自下一时刻目标位置的方法:
双飞行器根据导航成本函数
Figure RE-DEST_PATH_IMAGE004
从各自三个备选航路点中选择最优点作为目标位置;
设双飞行器为
Figure RE-DEST_PATH_IMAGE005
,成本函数工作原理中的标注符号说明如下:
Figure RE-507672DEST_PATH_IMAGE002
为双飞行器之间的距离,
Figure RE-487129DEST_PATH_IMAGE003
为双飞行器到搜寻区域边界的距离;
Figure RE-DEST_PATH_IMAGE007
表示飞行器时刻的备选航路点1的坐标,表示飞行器
Figure RE-789639DEST_PATH_IMAGE005
Figure RE-604011DEST_PATH_IMAGE008
时刻的备选航路点2的坐标,
Figure RE-DEST_PATH_IMAGE010
表示飞行器
Figure RE-488790DEST_PATH_IMAGE005
Figure RE-755824DEST_PATH_IMAGE008
时刻的备选航路点3的坐标;同理,表示飞行器
Figure RE-17041DEST_PATH_IMAGE006
Figure RE-685919DEST_PATH_IMAGE008
时刻的备选航路点1的坐标,
Figure RE-DEST_PATH_IMAGE012
表示飞行器
Figure RE-741600DEST_PATH_IMAGE006
Figure RE-495930DEST_PATH_IMAGE008
时刻的备选航路点2的坐标,
Figure RE-DEST_PATH_IMAGE013
表示飞行器
Figure RE-295258DEST_PATH_IMAGE006
Figure RE-818644DEST_PATH_IMAGE008
时刻的备选航路点3的坐标;以此标注方法类推,坐标中
Figure RE-DEST_PATH_IMAGE014
的上标第一项表示飞行器名称,上标第二项表示搜寻的时刻,下标表示下一时刻备选航路点的序号,即符号i;以飞行器
Figure RE-310805DEST_PATH_IMAGE005
为例,说明导航成本的工作原理:飞行器A 1根据当前位置当前时刻(t=0)
Figure RE-DEST_PATH_IMAGE017
及当前航向,产生一个时间步长后,即下一时刻t=1,3个备选航路点:
Figure RE-DEST_PATH_IMAGE018
Figure RE-DEST_PATH_IMAGE019
Figure RE-DEST_PATH_IMAGE020
;同理,飞行器A 2也用该规则产生3个备选航路点:
Figure RE-DEST_PATH_IMAGE021
Figure RE-DEST_PATH_IMAGE022
Figure RE-DEST_PATH_IMAGE023
;飞行器A 1的三个备选航路点分别依次与飞行器A 2的三个备选航路点之间产生9个S i ,作为备选;同时,A 1的三个备选航路点
Figure RE-DEST_PATH_IMAGE024
Figure RE-DEST_PATH_IMAGE025
Figure RE-DEST_PATH_IMAGE026
产生3个S j ,作为备选;将这些备选值一一代入
Figure RE-DEST_PATH_IMAGE027
,取该函数最小值的备选航点作为A 1下一时刻的航路点;
       同理,飞行器
Figure RE-792909DEST_PATH_IMAGE006
可得下一时刻的航路点。
3.一种基于双飞行机器人对有源目标的协调搜寻***,应用于根据权利要求1所述的基于双飞行机器人对有源目标的协调搜寻方法,包括两个无人飞行机器人、每个无人飞行机器人上各装有GPS定位仪,无线通讯设备、信号测向仪、飞行控制***、主控单元;其中,GPS定位仪采集双飞行器的位置信息,以确定双飞行器的当前位置;无线通讯设备用于双飞行器之间的通信,以共享搜寻信息,其特征在于,飞行器通过无线通讯设备与友机进行通讯,将各自的航路点信息与更新的地图信息发送给友机,同时从友机接受信息;信号测向仪用于探测有源目标;飞行控制***用于控制飞行器的飞行状态;主控单元用于整个飞行器的全局控制;所述信号测向仪与主控单元通过RS-232与串口连接,进行测向信号传输;飞行控制***与主控单元CAN总线连接,实时传输导航飞行控制信息;GPS定位仪通过RS-232串口与主控单元连接,向主控单元传输无人飞行机器人的位置信息;无线通讯设备与主控单元通过RS-232串口连接,实现与友机进行通讯。
CN201210424981.3A 2012-10-31 2012-10-31 基于双飞行机器人对有源目标的协调搜寻方法与*** Active CN103217985B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210424981.3A CN103217985B (zh) 2012-10-31 2012-10-31 基于双飞行机器人对有源目标的协调搜寻方法与***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210424981.3A CN103217985B (zh) 2012-10-31 2012-10-31 基于双飞行机器人对有源目标的协调搜寻方法与***

Publications (2)

Publication Number Publication Date
CN103217985A true CN103217985A (zh) 2013-07-24
CN103217985B CN103217985B (zh) 2016-06-29

Family

ID=48815881

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210424981.3A Active CN103217985B (zh) 2012-10-31 2012-10-31 基于双飞行机器人对有源目标的协调搜寻方法与***

Country Status (1)

Country Link
CN (1) CN103217985B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103823232A (zh) * 2014-03-18 2014-05-28 黑龙江省科学院技术物理研究所 核辐射探测飞行器
CN106371452A (zh) * 2015-07-24 2017-02-01 深圳市道通智能航空技术有限公司 一种飞行器限飞区域信息的获取、共享方法、装置及***
CN108613676A (zh) * 2018-03-27 2018-10-02 中国民用航空飞行学院 一种无人机和有人机协同机制下的多机多目标应急搜救航迹规划方法
CN110262563A (zh) * 2018-05-23 2019-09-20 中国海洋大学 多无人机协同搜索水上目标的方法
CN111532427A (zh) * 2015-07-17 2020-08-14 松下电器(美国)知识产权公司 无人飞行器、方法和存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1010988A2 (en) * 1998-12-10 2000-06-21 Hughes Electronics Corporation Method and system for incorporating two-way ranging navigation as a calibration reference for GPS
CN101561493A (zh) * 2009-05-26 2009-10-21 上海大学 基于双飞行机器人对有源目标的定位方法与***
CN102331264A (zh) * 2010-06-04 2012-01-25 通用汽车环球科技运作有限责任公司 利用导航***对旅行路线的几何约束
TW201209377A (en) * 2010-04-23 2012-03-01 Tomtom Int Bv Navigation devices and methods carried out thereon

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1010988A2 (en) * 1998-12-10 2000-06-21 Hughes Electronics Corporation Method and system for incorporating two-way ranging navigation as a calibration reference for GPS
CN101561493A (zh) * 2009-05-26 2009-10-21 上海大学 基于双飞行机器人对有源目标的定位方法与***
TW201209377A (en) * 2010-04-23 2012-03-01 Tomtom Int Bv Navigation devices and methods carried out thereon
CN102331264A (zh) * 2010-06-04 2012-01-25 通用汽车环球科技运作有限责任公司 利用导航***对旅行路线的几何约束

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
何玉庆等: "基于UKF的双飞行机器人三维动目标合作定位与跟踪方法", 《POREEEDINGS OF THE 31ST CHINESE》 *
彭飞等: "基于代价函数的组合导航***地图匹配算法", 《北京航空航天大学学报》 *
王金泉等: "双架次无人机(UAV)协同侦察的航路轨迹研究", 《计算机工程与科学》 *
童金等: "多无人机搜寻有源目标模拟实验控制***的研究", 《制造业自动化》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103823232A (zh) * 2014-03-18 2014-05-28 黑龙江省科学院技术物理研究所 核辐射探测飞行器
CN111532427A (zh) * 2015-07-17 2020-08-14 松下电器(美国)知识产权公司 无人飞行器、方法和存储介质
CN106371452A (zh) * 2015-07-24 2017-02-01 深圳市道通智能航空技术有限公司 一种飞行器限飞区域信息的获取、共享方法、装置及***
CN106371452B (zh) * 2015-07-24 2020-08-25 深圳市道通智能航空技术有限公司 一种飞行器限飞区域信息的获取、共享方法、装置及***
CN108613676A (zh) * 2018-03-27 2018-10-02 中国民用航空飞行学院 一种无人机和有人机协同机制下的多机多目标应急搜救航迹规划方法
CN108613676B (zh) * 2018-03-27 2019-07-12 中国民用航空飞行学院 一种无人机和有人机协同机制下的应急搜救航迹规划方法
CN110262563A (zh) * 2018-05-23 2019-09-20 中国海洋大学 多无人机协同搜索水上目标的方法

Also Published As

Publication number Publication date
CN103217985B (zh) 2016-06-29

Similar Documents

Publication Publication Date Title
CN104850134B (zh) 一种无人机高精度自主避障飞行方法
US10571932B2 (en) Navigation system for a drone
JP7109174B2 (ja) 経路選定装置、無人航空機、データ処理装置、経路選定処理方法および経路選定処理用プログラム
CN110888456B (zh) 一种无人机与无人车的自主协同侦察控制方法
CN101561493B (zh) 基于双飞行机器人对有源目标的定位方法与***
CN109901580A (zh) 一种无人机与无人地面机器人协作循径避障***及其方法
JP6598154B2 (ja) 爆発物探知システム
CN110609552A (zh) 一种水下无人航行器编队平面航迹规划方法
CN105973230B (zh) 一种双无人机协同感知与规划方法
CN103217985A (zh) 基于双飞行机器人对有源目标的协调搜寻方法与***
CN109911237A (zh) 基于紫外光对空编码信标的无人机助降与引导***及应用
CN108008738A (zh) 基于无人机与无人车协同下的目标跟踪***
CN105513434A (zh) 无人机飞行管制***及其管制方法
EP4042105B1 (en) Map including data for routing aerial vehicles during gnss failure
CN104714555A (zh) 一种基于边缘的三维自主探索方法
CN102937443A (zh) 一种基于无人机的目标快速定位***及方法
US20190066522A1 (en) Controlling Landings of an Aerial Robotic Vehicle Using Three-Dimensional Terrain Maps Generated Using Visual-Inertial Odometry
US20230168332A1 (en) Method for assisting in the location of at least one sunken element in a predetermined search zone, associated system and electronic equipment
CN107065848A (zh) 一种基于高精度定位导航终端的井下矿机车无人驾驶***及方法
EP4024368A1 (en) Distribution device, aircraft, flight system, method for these, and non-transitory computer readable medium
CN108681333A (zh) 一种无人机导航装置失效下的雷达返航***
Stone et al. Design and deployment of a four-degrees-of-freedom hovering autonomous underwater vehicle for sub-ice exploration and mapping
CN109801484A (zh) 一种应急通信无人机***及应急通信***
CN116661497A (zh) 一种智能飞行汽车
Xiang et al. A Multi-stage Precision Landing Method for Autonomous eVTOL Based on Multi-marker Joint Localization

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20221109

Address after: 200444 Room 190, Building A, 5/F, Building 1, No. 1000 Zhenchen Road, Baoshan District, Shanghai

Patentee after: Jinghai Intelligent Equipment Co.,Ltd.

Address before: 200444 No. 99, upper road, Shanghai, Baoshan District

Patentee before: Shanghai University