一种无人机群夜间协同定位方法技术

本发明专利技术属于飞行器导航定位技术领域，公开了一种无人机群夜间协同定位方法，本发明专利技术通过无人机的灯光颜色和各自的二维转台相机，以及通讯拓扑网络实现对无人机的协同视觉定位和碰撞告警，无需增加额外设备，无需依赖外部信号源，避免了受到外界干扰，相较于传统方式当中的定位方法，本发明专利技术有效简化了系统，能够较为简单地、低成本地实现对无人集群内部之间的协同定位、实现无人机群编队的保持。实现无人机群编队的保持。实现无人机群编队的保持。

【技术实现步骤摘要】
一种无人机群夜间协同定位方法


[0001]本专利技术属于飞行器导航定位
，涉及一种无人机群夜间协同定位方法。

技术介绍

[0002]随着科学技术的发展，无人机集群在军事领域和民用领域都具有广阔的应用前景，特别是面向未来临地安防体系下的低空安防，无人机集群因具有作战能力强、体系生存率高以及攻击成本低等诸多优势，对我国工业生产、社会经济、科研教育等方面的防护、生产、安全、救援，以及对国防安全、社会稳定、经济发展均具有重要意义。而如何获取集群内各无人机之间高精度、高可靠的相对时空关系对于无人机集群飞行安全和任务的执行至关重要。因此，快速、经济和高质量的无人集群协同定位技术的需求和必要程度日益剧增。
[0003]目前，国内外学者在无人机集群自主相对定位领域已取得了丰富成果，并提出了一系列方法，如激光脉冲测距定位、UWB测距定位、视觉测距定位、超声波测距定位以及无线电测距定位等，被广泛应用到各个领域。激光脉冲测距定位成本极为高昂；UWB测距定位稳定性差，还可能干扰其他无线通讯；超声波测距定位采集速度慢，适用范围较小；无线电测距定位易被干扰，可靠性差。其中，视觉定位相比于其他几类方法，具有低成本、无源被动感知、低可探测性等的优点，是未来的重要研究方向之一，而现有的视觉测距定位主要是采用双目相机，计算任务繁重，且无法满足夜间使用需求的。
[0004]与此同时，无人机集群应用的终极目标是适应全天候全场景需求，为此主要面对的是来自复杂环境的挑战。目前在复杂地理和气象环境已经有了许多相关研究成果，而对于夜间条件下依靠无人机自身进行协同定位感知的研究较少，而夜间是无人机集群重要应用场景之一，特别是在军事领域。因此就需要一种夜间无人机群内部视觉协同定位方法来保证无人机集群在夜间环境下的正常运作。

技术实现思路

[0005]针对现有技术存在的上述不足，本专利技术的目的在于提供一种无人机群夜间协同定位方法。
[0006]为实现以上目的，本专利技术采用如下技术方案：一个无人机群包括5台无人机，每台无人机均包含一个二维转台相机和一个LED灯，包括如下步骤：步骤1：无人集群编队起飞前布置将无人机群的无人机1、无人机2、无人机3和无人机4按照矩形编队顺次布置于起飞场地，无人机0置于矩形中心也即矩形对角线的交叉点，并确保相邻无人机之间的初始实际距离大于相互之间的安全半径之和，且保证在无人机0航向前方的无人机1和无人机2的LED灯不会出现在无人机0的相机视线范围内；步骤2：无人集群编队上电；步骤3：设置各无人机的LED灯光颜色；
矩形对角的两台无人机的LED灯设置为设置颜色Ⅰ，矩形另一个对角的两台无人机的LED灯设置为颜色Ⅱ，无人机0的LED灯设置为颜色Ⅲ，其中颜色Ⅰ、颜色Ⅱ和颜色Ⅲ为不同的颜色；步骤4：无人机起飞前自动基准构建，包括定位基准构建和时间基准构建；步骤5：通过外部系统的控制指令实现对无人机0的起飞控制；同时，当在飞行过程中，无人机1或无人机2的LED灯光进入无人机0的相机视角范围内时，即无人机0相机成像平面中将会出现颜色Ⅰ或颜色Ⅱ的LED灯光像素点时，无人机0将通过通讯拓扑发送给无人机1或人机2防碰撞告警指令；步骤6：随着无人机0起飞动作，使得无人机0颜色Ⅲ的LED灯在无人机1～无人机4的相机成像平面内的实时像素坐标值发生变化，从而通过无人机1～无人机4姿态控制器计算其与无人机1～无人机4地面记录存储的像素坐标值（x10，y10）～（x40，y40）之间的偏差，进而通过闭环控制，最终实现对无人机0的起飞等动作的跟随。
[0007]进一步地，所述定位基准构建具体过程包括：步骤4.1.1：设置无人机0的二维转台相机轴线与其航向的夹角α0为零；步骤4.1.2：无人机1～无人机4分别顺时针自动旋转其二维转台相机搜索无人机0颜色Ⅲ的LED灯光，并使得颜色Ⅲ的LED灯光位于其相机成像平面的水平中心处；步骤4.1.3：记录并存储此时无人机0～无人机4的二维转台相机轴线与其航向的α0～α4夹角值；步骤4.1.4：启动二维转台相机夹角闭环保持控制程序，使得在后续整个飞行过程中α0～α4夹角值与起飞前的记录存储值保持一致；步骤4.1.5：记录并存储此时无人机0的LED的颜色Ⅲ光点分别在无人机1～无人机4相机成像平面的像素坐标值（x10，y10）～（x40，y40）；同时，记录并存储此时无人机1与无人机2的LED灯光分别在对方的相机成像平面内的像素坐标（x12，y12）和（x21，y21），无人机3与无人机4的LED灯光分别在对方的相机成像平面内的像素坐标（x34，y34）和（x43，y43）；步骤4.1.6：依靠有向通讯拓扑实现无人机1获取其分别在无人机2和无人机4相机成像平面内的像素坐标（x21，y21）和（x41，y41），从而获得无人机1在集群中的协同定位基准信息记为{（x10，y10）,（x21，y21）,（x41，y41）}；同理，无人机2～4可分别获取其在集群中的协同定位基准信息{（x20，y20）,（x12，y12）,（x32，y32）}、{（x30，y30）,（x23，y23）,（x43，y43）}和{（x40，y40）,（x14，y14）,（x34，y34）}；并将此协同定位基准信息作为后续无人机1～无人机4的位置控制指令。
[0008]进一步地，所述时间基准构建包括：进行各无人机之间的通讯时钟同步。
[0009]进一步地，在飞行过程中，无人机1～无人机4中任意一台的位置变化都将导致实时监测的各无人机LED灯光像素坐标值与其协同定位基准之间的偏差，进而通过其姿态闭环控制器实现无人机群编队保持。
[0010]进一步地，步骤4.1.6中的有向通讯拓扑具体为：无人机1同无人机2和无人机4之间均为双向通信关系；无人机3同无人机2和4之间均为双向通信关系；无人机1与无人机3之间无通讯关系，无人机2和4之间为无通讯关系；无人机0同无人机1和无人2之间均为单向通讯关系，其中无人机0为信息发送方。
[0011]优选地，所述相机为单目相机。
[0012]进一步地优选地，所述单目相机的视角为90
°
。
[0013]优选地，所述LED灯能够通过驱动软件进行灯光颜色的设置。
[0014]本申请所述的安全半径为无人机机体最大轮廓外接圆半径的2倍。
[0015]与现有技术相比，本专利技术具有以下有益效果：本专利技术通过无人机LED灯和二维转台相机实现了夜间无人机群协同视觉定位，无需增加额外设备，无需依赖GPS、激光雷达和超声波雷达等，无需依赖外部信号源，避免了受到外界干扰，相较于传统方式当中的定位方法，本专利技术有效简化了系统，能够较为简单地、低成本地实现对无人集群内部之间的协同定位、实现无人机群编队的保持。
附图说明
[0016]通过阅读参照以下附图对非限制性实施例所作的详细描述，本专利技术的其它特征、目的和优点将会变得更明显：图1为本专利技术实施例技术方案图。
[0017]图2为本专利技术实施例通讯拓扑有向图。
[0018]图3为本专利技术实施例的工作流程图。...

【技术保护点】

【技术特征摘要】
1.一种无人机群夜间协同定位方法，其特征在于，一个无人机群包括5台无人机，每台无人机均包含一个二维转台相机和一个LED灯，包括如下步骤：步骤1：无人集群编队起飞前布置将无人机群的无人机1、无人机2、无人机3和无人机4按照矩形编队顺次布置于起飞场地，无人机0置于矩形中心也即矩形对角线的交叉点，并确保相邻无人机之间的初始实际距离大于相互之间的安全半径之和，且保证在无人机0航向前方的无人机1和无人机2的LED灯不会出现在无人机0的相机视线范围内；步骤2：无人集群编队上电；步骤3：设置各无人机的LED灯光颜色；矩形对角的两台无人机的LED灯设置为设置颜色Ⅰ，矩形另一个对角的两台无人机的LED灯设置为颜色Ⅱ，无人机0的LED灯设置为颜色Ⅲ，其中颜色Ⅰ、颜色Ⅱ和颜色Ⅲ为不同的颜色；步骤4：无人机起飞前自动基准构建，包括定位基准构建和时间基准构建；步骤5：通过外部系统的控制指令实现对无人机0的起飞控制；同时，当在飞行过程中，无人机1或无人机2的LED灯光进入无人机0的相机视角范围内时，即无人机0相机成像平面中将会出现颜色Ⅰ或颜色Ⅱ的LED灯光像素点时，无人机0将通过通讯拓扑发送给无人机1或人机2防碰撞告警指令；步骤6：随着无人机0起飞动作，使得无人机0颜色Ⅲ的LED灯在无人机1～无人机4的相机成像平面内的实时像素坐标值发生变化，从而通过无人机1～无人机4姿态控制器计算其与无人机1～无人机4地面记录存储的像素坐标值（x10，y10）～（x40，y40）之间的偏差，进而通过闭环控制，最终实现对无人机0的起飞等动作的跟随。2.根据权利要求1所述的无人机群夜间协同定位方法，其特征在于，所述定位基准构建具体过程包括：步骤4.1.1：设置无人机0的二维转台相机轴线与其航向的夹角α0为零；步骤4.1.2：无人机1～无人机4分别顺时针自动旋转其二维转台相机搜索无人机0颜色Ⅲ的LED灯光，并使得颜色Ⅲ的LED灯光位于其相机成像平面的水平中心处；步骤4.1.3：记录并存储此时无人机0～无人机4的二维转台相机轴线与其航向的α0～α4夹角值；步骤4.1.4：启动二维转台相机夹角闭环保持控制程序，使得在后续整个飞行过程中α0～α4夹角值与起飞前的记录存储值保持一致；步骤4.1.5：记录并存储此时无人机0的LED的颜...

【专利技术属性】
技术研发人员：王震，张涛，于登秀，高超，李学龙，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：