一种无人机群的导航控制方法

申请号 CN201710667895.8 申请日 2017-08-07 公开(公告)号 CN107289953A 公开(公告)日 2017-10-24
申请人 深圳市华琥技术有限公司; 发明人 邓欢欢;
摘要 本 发明 公开了一种无人机群的导航控制方法,通过对无人机群中的各个无人机确定飞行路线;各个所述无人机根据飞行路线飞行至目的地的过程中,实时将飞行的 位置 数据信息发送至后台 服务器 ;所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。本发明所公开的导航方法,无人机群可以根据计算出的飞行方向和飞行距离自主进行飞行控制,并且各个无人机之间的飞行状况可以通过后台服务器进行监控,避免发生飞行异常,因此多个无人机之间的协同作业可以执行更复杂的作业任务,为任务的完成提供了保障。
权利要求

1.一种无人机群的导航控制方法,其特征在于,所述方法包括以下步骤:
无人机群中的各个无人机确定当前位置信息和用户输入的目的地位置信息;
各个无人机根据所述当前位置信息和所述目标位置信息确定各自的飞行方向;
各个无人机根据所述当前位置信息、所述目标位置信息及所述摄像头的拍摄度,确定所述无人机需要飞行的飞行距离;
各个所述无人机根据所述飞行方向和所述飞行距离飞行至目的地的过程中,实时将飞行的位置数据信息发送至后台服务器
所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。
2.根据权利要求1所述的无人机群的导航控制方法,其特征在于,所述步骤中无人机根据所述当前位置信息和所述目标位置信息确定飞行方向的方法包括:
将各个无人机当前位置信息中包含的GPS坐标和其所对应的目标位置信息所包含的GPS坐标进行连线,以该连线方向作为飞行方向。
3.根据权利要求2所述的无人机群的导航控制方法,其特征在于,所述步骤中通过以下公式确定各个所述无人机所需飞行的飞行距离:
S=(2×M×N×tana)/(P×sinb);
其中:S为飞行距离、M为目标位置中包含的空间横坐标、N为无人机的当前位置与地面的垂直高度、a为安装在无人机正下方的摄像头平视角的半角、P为空间坐标系的横轴长度,b为第一直线与第二直线之间的夹角,所述第一直线为从摄像头出发竖直向下的直线,所述第二直线为:从所述摄像头出发,水平方向上与所述摄像头在横轴方向上的视线范围线段中的中点所构成的直线。
4.根据权利要求3所述的无人机群的导航控制方法,其特征在于,所述方法中还包括步骤:
各个无人机在飞行过程中实时检测电量,若电量低于预置电量值,则将距离最近的无人机充电基站作为中途点,并将所述中途点作为起点,将目标位置作为终点,计算从所述起点到终点之间的第二飞行距离,并根据所述第二飞行距离飞行至终点。
5.根据权利要求4所述的无人机群的导航控制方法,其特征在于,所述方法中还包括步骤:
无人机在飞到无人机充电基站后,通过底部摄像头进行图像识别,瞄准充电接口,并且在无人机底部设置有磁接口,无人机充电基站的充电接口附近也设置有磁铁接口,用来准确对准充电接口。
6.根据权利要求4所述的无人机群的导航控制方法,其特征在于,所述方法中还包括步骤:
各个无人机在飞行过程中不断进行数据广播,判断是否收到来自其他无人机返回的回应信息;
如果收到回应信息,根据该回应信息与该回应无人机建立通讯连接;
建立通讯连接的无人机之间互相交换自身的导航信息,并根据对方的导航信息判断存在相撞险;
若存在相撞风险则自动调整高度。
7.根据权利要求6所述的无人机群的导航控制方法,其特征在于,所述方法中所述位置数据信息包括:无人机飞行速度、无人机当前所在位置的GPS坐标和无人机当前飞机的飞行方向。
8.根据权利要求7所述的无人机群的导航控制方法,其特征在于,所述方法中后台服务器控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致的步骤包括:
后台服务器根据所述位置数据信息不断发送调整指令至飞行控制器,所述飞行控制器接收调整指令,控制调整四个或6个螺旋桨的转速和方向,使得所述无人机当前的飞行方向与计算出的飞行方向保持一致。
9.根据权利要求8所述的无人机群的导航控制方法,其特征在于,所述方法还包括步骤:
后台服务器根据接收到的所述位置数据信息,判断各个无人机是否在预定时间范围内处于飞行路径中设置的虚拟目标点上空;若存在无人机未在预定时间范围内处于虚拟目标点上空,则对其进行飞行速度进行调节,控制无人机准时处于下一个虚拟目标点上空。
10.根据权利要求9所述的无人机群的导航控制方法,其特征在于,所述方法还包括步骤:
各个无人机还用于将飞行过程实时采集的图像传输到后台服务器;
所述后台服务器对接收到的图像进行直播显示。

说明书全文

一种无人机群的导航控制方法

技术领域

[0001] 本发明无人机控制领域,尤其涉及一种无人机群的导航控制方法。

背景技术

[0002] 无人机的研究在最近几年有了很大的进展,被广泛应用与民用方面的通信中继、气象探测、灾害监测、农药喷洒、地质勘测、地图测绘、交通管制以及军用方面的侦察、攻击和电子对抗。
[0003] 无人机体积小、重量轻、易维修等优点得到了广泛的推广,但是由于单个无人机的载荷有限,单个无人机与地面站之间的数据通信中断时会直接导致任务的失败,甚至会有坠机的危险,而且单个无人机在应对广阔的任务区域以及单个无人机故障后将无法完成任务的不利因素,这就使得利用多个无人机间的协作以执行更为复杂任务的要求逐渐成为无人机研究的趋势。
[0004] 因此,现有技术需要进一步的改进。

发明内容

[0005] 本发明提供了一种无人机群的导航控制方法,能够实现整个无人机群组内的各个无人机之间的导航,从而提高控制无人机在处理复杂任务时的共同作业的能,解决单个无人机处理复杂任务时载荷有限,无法顺利完成任务的缺陷
[0006] 本发明所提供的方法具体技术方案如下:
[0007] 一种无人机群的导航控制方法,其中,所述方法包括以下步骤:
[0008] 无人机群中的各个无人机确定当前位置信息和用户输入的目的地位置信息;
[0009] 各个无人机根据所述当前位置信息和所述目标位置信息确定各自的飞行方向;
[0010] 各个无人机根据所述当前位置信息、所述目标位置信息及所述摄像头的拍摄度,确定所述无人机需要飞行的飞行距离;
[0011] 各个所述无人机根据所述飞行方向和所述飞行距离飞行至目的地的过程中,实时将飞行的位置数据信息发送至后台服务器
[0012] 所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。
[0013] 所述的无人机群的导航控制方法,其中,所述步骤中无人机根据所述当前位置信息和所述目标位置信息确定飞行方向的方法包括:
[0014] 将各个无人机当前位置信息中包含的GPS坐标和其所对应的目标位置信息所包含的GPS坐标进行连线,以该连线方向作为飞行方向。
[0015] 所述的无人机群的导航控制方法,其中,所述步骤中通过以下公式确定各个所述无人机所需飞行的飞行距离:
[0016] S=(2×M×N×tana)/(P×sinb);
[0017] 其中:S为飞行距离、M为目标位置中包含的空间横坐标、N为无人机的当前位置与地面的垂直高度、a为安装在无人机正下方的摄像头平视角的半角、P为空间坐标系的横轴长度,b为第一直线与第二直线之间的夹角,所述第一直线为从摄像头出发竖直向下的直线,所述第二直线为:从所述摄像头出发,水平方向上与所述摄像头在横轴方向上的视线范围线段中的中点所构成的直线。
[0018] 所述的无人机群的导航控制方法,其中,所述方法中还包括步骤:
[0019] 各个无人机在飞行过程中实时检测电量,若电量低于预置电量值,则将距离最近的无人机充电基站作为中途点,并将所述中途点作为起点,将目标位置作为终点,计算从所述起点到终点之间的第二飞行距离,并根据所述第二飞行距离飞行至终点。
[0020] 所述的无人机群的导航控制方法,其中,所述方法中还包括步骤:
[0021] 无人机在飞到无人机充电基站后,通过底部摄像头进行图像识别,瞄准充电接口,并且在无人机底部设置有磁接口,无人机充电基站的充电接口附近也设置有磁铁接口,用来准确对准充电接口。
[0022] 所述的无人机群的导航控制方法,其中,所述方法中还包括步骤:
[0023] 各个无人机在飞行过程中不断进行数据广播,判断是否收到来自其他无人机返回的回应信息;
[0024] 如果收到回应信息,根据该回应信息与该回应无人机建立通讯连接;
[0025] 建立通讯连接的无人机之间互相交换自身的导航信息,并根据对方的导航信息判断存在相撞险;
[0026] 若存在相撞风险则自动调整高度。
[0027] 所述的无人机群的导航控制方法,其中,所述方法中所述位置数据信息包括:无人机飞行速度、无人机当前所在位置的GPS坐标和无人机当前飞机的飞行方向。
[0028] 所述的无人机群的导航控制方法,其中,所述方法中后台服务器控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致的步骤包括:
[0029] 后台服务器根据所述位置数据信息不断发送调整指令至飞行控制器,所述飞行控制器接收调整指令,控制调整四个或6个螺旋桨的转速和方向,使得所述无人机当前的飞行方向与计算出的飞行方向保持一致。
[0030] 所述的无人机群的导航控制方法,其中,所述方法还包括步骤:
[0031] 后台服务器根据接收到的所述位置数据信息,判断各个无人机是否在预定时间范围内处于飞行路径中设置的虚拟目标点上空;若存在无人机未在预定时间范围内处于虚拟目标点上空,则对其进行飞行速度进行调节,控制无人机准时处于下一个虚拟目标点上空。
[0032] 所述的无人机群的导航控制方法,其中,所述方法还包括步骤:
[0033] 各个无人机还用于将飞行过程实时采集的图像传输到后台服务器;
[0034] 所述后台服务器对接收到的图像进行直播显示。
[0035] 本发明公开了一种无人机群的导航控制方法,无人机群中的各个无人机确定当前位置信息和用户输入的目的地位置信息;各个无人机根据所述当前位置信息和所述目标位置信息确定各自的飞行方向;各个无人机根据所述当前位置信息、所述目标位置信息及所述摄像头的拍摄角度,确定所述无人机需要飞行的飞行距离;各个所述无人机根据所述飞行方向和所述飞行距离飞行至目的地的过程中,实时将飞行的位置数据信息发送至后台服务器;所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。本发明所公开的导航方法,无人机群可以根据计算出的飞行方向和飞行距离自主进行飞行控制,并且各个无人机之间的飞行状况可以通过后台服务器进行监控,避免发生飞行异常,因此多个无人机之间的协同作业可以执行更复杂的作业任务,为任务的完成提供了保障。附图说明
[0036] 图1为本发明所提供的无人机群的导航控制方法的步骤流程图

具体实施方式

[0037] 为了使本领域的技术人员更好的理解本发明的技术方案,下面结合附图和具体实施方式对本发明作进一步的详细说明。
[0038] 本发明提供了一种无人机群的导航控制方法,如图1所示,所述方法包括以下步骤:
[0039] 步骤101、无人机群中的各个无人机确定当前位置信息和用户输入的目的地位置信息。
[0040] 本方法中由于是整个无人机群中多个无人机的共同作业,因此首先需要依次针对各个无人机所要执行的飞行任务,分别为无人机输入各自的目的地位置信息。
[0041] 可以想到的是,整个无人机群可以执行的相同的任务,比如:可以同时相同一个位置地点投放物品,也可以分别执行将物品投放到不同的位置地点,因此无人机群可以根据需要控制群内的无人机执行相应的任务。
[0042] 步骤102、各个无人机根据所述当前位置信息和所述目标位置信息确定各自的飞行方向。
[0043] 当各个无人机获取到目标位置信息后,分别根据其当前位置信息计算飞行至目标位置的飞行方向。
[0044] 具体的,本步骤中无人机根据所述当前位置信息和所述目标位置信息确定飞行方向的方法包括:
[0045] 将各个无人机当前位置信息中包含的GPS坐标和其所对应的目标位置信息所包含的GPS坐标进行连线,以该连线方向作为飞行方向。
[0046] 步骤103、各个无人机根据所述当前位置信息、所述目标位置信息及所述摄像头的拍摄角度,确定所述无人机需要飞行的飞行距离。
[0047] 各个无人机根据当前位置信息和其各自所对应的目标位置信息,以及各个无人机上安装的摄像头的拍摄角度,计算该无人机所需要飞行的飞行距离。
[0048] 具体的,本步骤中通过以下公式确定各个所述无人机所需飞行的飞行距离:
[0049] S=(2×M×N×tana)/(P×sinb);
[0050] 其中:S为飞行距离、M为目标位置中包含的空间横坐标、N为无人机的当前位置与地面的垂直高度、a为安装在无人机正下方的摄像头水平视角的半角、P为空间坐标系的横轴长度,b为第一直线与第二直线之间的夹角,所述第一直线为从摄像头出发竖直向下的直线,所述第二直线为:从所述摄像头出发,水平方向上与所述摄像头在横轴方向上的视线范围线段中的中点所构成的直线。
[0051] 具体的,上述公式中的坐标为空间坐标系的三维空间坐标,其中摄像头为安装在无人机正下方的摄像头。
[0052] 步骤104、各个所述无人机根据所述飞行方向和所述飞行距离飞行至目的地的过程中,实时将飞行的位置数据信息发送至后台服务器。
[0053] 各个所述无人机根据上述步骤中计算出的飞行方向和飞行距离,规划出各自的飞行路线,并根据所述飞行路线飞行,且在飞行的同时将飞行时的实时位置数据信息发送至后台服务器。
[0054] 因此为了满足本步骤,无人机需要通过通讯模与后台服务器建立通讯连接,并且无人机实时采集自身的位置数据信息,并将位置数据信息通过通讯模块发送至后台服务器。
[0055] 具体的,所述方法中所述位置数据信息包括:无人机飞行速度、无人机当前所在位置的GPS坐标和无人机当前飞机的飞行方向。
[0056] 步骤105、所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。
[0057] 后台服务器接收无人机发送的位置数据信息,且在上述步骤中还包括:
[0058] 后台服务器根据所述位置数据信息不断发送调整指令至飞行控制器,所述飞行控制器接收调整指令,控制调整四个或6个螺旋桨的转速和方向,使得所述无人机当前的飞行方向与计算出的飞行方向保持一致。
[0059] 为保证无人机在预定的路径上稳定飞行,本步骤还包括:
[0060] 后台服务器根据接收到的所述位置数据信息,判断各个无人机是否在预定时间范围内处于飞行路径中设置的虚拟目标点上空;若存在无人机未在预定时间范围内处于虚拟目标点上空,则对其进行飞行速度进行调节,控制无人机准时处于下一个虚拟目标点上空。
[0061] 较佳的,在上述方法中,为了避免各个无人机在飞行中途出现电量不足的情况,所述方法中还可以包括步骤:
[0062] 各个无人机在飞行过程中实时检测电量,若电量低于预置电量值,则将距离最近的无人机充电基站作为中途点,并将所述中途点作为起点,将目标位置作为终点,计算从所述起点到终点之间的第二飞行距离,并根据所述第二飞行距离飞行至终点。
[0063] 具体在实施过程中,可以通过实时检测无人机的电量值避免发生由于电量低无法实现无人机完成任务的情况发生。当检测到无人机电量值低于预置的电量值后,则可以查找与当前位置最近的无人机充电基站,并在无人机充电基站充电完成后,再继续飞行至目标位置,因此无人机需要首先飞行至无人机充电基站,充电完成后,计算以无人机充电基站为起点、以目标位置为终点的第二飞行距离,根据所述第二飞行距离飞行至目标位置。
[0064] 为了实现快速充电,还可以设置:
[0065] 无人机在飞到无人机充电基站后,通过底部摄像头进行图像识别,瞄准充电接口,并且在无人机底部设置有磁铁接口,无人机充电基站的充电接口附近也设置有磁铁接口,用来准确对准充电接口。
[0066] 优选的,当无人机飞行至无人机充电基站,尝试充电时,可以通过底部设置的摄像头进行图像识别实现充电接口的接入,具体的,所述充电接口底部设置有磁铁接口,无人机充电接口也同样设置有磁铁接口,且两个磁铁接口之间的极性相反,从而便于充电接口的接入。
[0067] 所述方法中还包括步骤:
[0068] 各个无人机在飞行过程中不断进行数据广播,判断是否收到来自其他无人机返回的回应信息;
[0069] 如果收到回应信息,根据该回应信息与该回应无人机建立通讯连接;
[0070] 建立通讯连接的无人机之间互相交换自身的导航信息,并根据对方的导航信息判断存在相撞风险;
[0071] 若存在相撞风险则自动调整高度。
[0072] 具体的,无人机在飞行过程中发送数据广播,根据其他无人机返回的所述数据广播的回应信息,获取感知该回应无人机的相关信息,并建立与该无人机之间的通讯连接,基于所述通讯连接获取该回应无人机当前的位置信息,并将该回应无人机的当前位置信息及其飞行方向与无人机当前所在位置及飞行方向进行计算,判断是否存在相撞风险,若有则自动调整飞行高度,规避相撞风险。
[0073] 所述方法还包括步骤:
[0074] 各个无人机还用于将飞行过程实时采集的图像传输到后台服务器;
[0075] 所述后台服务器对接收到的图像进行直播显示。从而实现控制人员不仅仅可以实时了解当前无人机的飞行状态,还可以得到其飞行过程的场景有个全面的了解。
[0076] 为了对本发明所公开的导航控制方法做更进一步的说明,下面对具体实施例进行解释。
[0077] 当使用本发明所公开的方法进行无人机群的导航进行控制时,主要含有以下步骤:
[0078] 步骤H1、首先确认群内的每个无人机均与后台服务器建立通讯连接,后台服务器可以通过每个无人机所具有的唯一标识,例如:各个无人机通讯模块的ID来对群内的无人机进行识别,并可以通过通信网络,发送控制指令到各个无人机所对应的控制器,通过控制器实现对各个无人机的控制。
[0079] 步骤H2、各个无人机确认本次执行任务所要抵达的目标位置信息,所述目标位置信息可以为一固定位置,也可以为一个区域的范围,各个无人机所抵达的目标位置可以为同一个,也可以是不同的。
[0080] 步骤H3、根据所述目标位置信息和各个无人机当前的位置信息,计算各个无人机飞行至所述目标位置所需要的飞行方向和飞行时间。
[0081] 步骤H4、根据计算出的飞行方向和飞行时间,各个无人机飞行至所述目标位置,并在飞行过程中,实时检测电量,实时发送数据广播,判断是否与其他无人机之间存在碰撞风险,若电量低,则查找附近的无人机充电站,进行充电,若存在碰撞风险,则调整飞行高度。
[0082] 步骤H5,飞行至目标位置的各个无人机,飞行过程中及在飞行目标位置后,均可以实时采集周围场景的图像,并将图像及自身的位置数据信息发送至后台服务器。
[0083] 步骤H6、后台服务器根据位置数据信息判断各个无人机是否发生异常,若有,则控制调整其有预设的导航路径保持一致(预设的导航路径也即是上述步骤中计算出的飞行方向和飞行距离),若不一致,则控制偏离的无人机飞行至预设导航路径。
[0084] 本发明公开了一种无人机群的导航控制方法,无人机群中的各个无人机确定当前位置信息和用户输入的目的地位置信息;各个无人机根据所述当前位置信息和所述目标位置信息确定各自的飞行方向;各个无人机根据所述当前位置信息、所述目标位置信息及所述摄像头的拍摄角度,确定所述无人机需要飞行的飞行距离;各个所述无人机根据所述飞行方向和所述飞行距离飞行至目的地的过程中,实时将飞行的位置数据信息发送至后台服务器;所述后台服务器根据接收到位置数据信息,实时监控各个无人机当前的飞行方向是否偏离计算出的飞行方向;若飞行方向发生偏离,则控制无人机将其当前飞行方向调整到与计算出的飞行方向保持一致。本发明所公开的导航方法,无人机群可以根据计算出的飞行方向和飞行距离自主进行飞行控制,并且各个无人机之间的飞行状况可以通过后台服务器进行监控,避免发生飞行异常,因此多个无人机之间的协同作业可以执行更复杂的作业任务,为任务的完成提供了保障。
[0085] 以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
QQ群二维码
意见反馈