一种控制无人机超视距丢GPS后返航到HOME位置的方法及装置与流程

本发明涉及无人机领域，具体涉及一种控制无人机超视距丢gps后返航到home位置的方法及装置。

背景技术：

无人机是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机。机上安装有自动驾驶仪、程序控制装置等设备。地面人员通过gps等设备，对其进行跟踪、定位、遥控、遥测和数字传输。无人机广泛用于空中侦察、监视、通信、反潜、电子干扰等领域。

固定翼无人机是无人机产品中一个重要类别，固定翼无人机超视距丢gps如何处理，是现在无人机行业的一个难题。现阶段的解决方案有以下几种：一、无人机就地绕圈，这种适合短时间的丢星策略；二、就地迫降，这种在不知道地面是什么情况就迫降的方式，是一个比较危险的策略；三、通过惯导估算位置返航，这种由于惯导长时间估算的位置偏差很大，基本上是不能回到home点。

因此，提供一种改进的控制无人机超视距丢gps后返航到home位置的方法实为必要。

技术实现要素：

本发明的目的是提供一种能够精确地控制无人机超视距丢gps后返航到home位置的方法。

为实现上述目的，本发明的一种技术方案是提供一种控制无人机超视距丢gps后返航到home位置的方法，包括以下步骤：步骤一：标定home位置的坐标p0；步骤二：在无人机丢gps后的预设时间内，利用惯导估算其决定返航的位置坐标p1、返航速度v以及无人机此刻的航向信息h0；步骤三：根据home位置的坐标p0、决定返航的位置坐标p1、返航速度v和预设的无人机盘旋半径r，获取无人机实际返航的位置坐标p2及无人机横滚的姿态角以及坐标p1和p0之间的连线与坐标p2和p0之间的连线的夹角β；步骤四：根据决定返航时的航向信息h0与夹角β，获取无人机实际返航时的航向信息h1；步骤五：根据p2和p0之间的距离以及飞机返航的速度v，获取无人机的返航时间t；步骤六：命令无人机盘旋至p2位置时，沿航向h1以横滚姿态角的方式飞行时间t后，即返航到home位置。

进一步的，在步骤二中，无人机丢gps后的预设时间为5秒-10秒。

进一步的，步骤四中，h1与h0之间的关系式为：当飞机被预设为逆时针盘旋时，h1＝h0+β；当飞机被预设为顺时针盘旋时，h1＝h0-β。

进一步的，步骤五中，根据p2和p0之间的距离以及飞机返航的速度v，获取无人机的返航时间t的具体步骤为：

考虑到无人机实际飞行的航向不可能一直保持h1航向，预设一时间补偿系数ζ，ζ的取值范围为1-1.5；

通过以下公式计算获取无人机的返航时间t：

进一步的，步骤六中，考虑到无人机实际飞行的航向不可能一直保持h1航向，横滚姿态角需要考虑航向偏差，具体计算公式如下：

将飞机当前航向记为hn，

获取航向偏差δhn，计算公式为：δhn＝hn-h1，

获取无人机的径向加速度ar，计算公式为：

获取无人机的横滚姿态角计算公式为：

为实现上述目的，本发明的另一种技术方案是提供一种无人机控制装置，包括：处理器、存储器以及通信电路，所述处理器耦接所述存储器和所述通信电路；所述存储器存储有程序数据的信息，所述通信电路用于信息传输，所述处理器在工作时执行所述程序数据以实现上述任一所述一种控制无人机超视距丢gps后返航到home位置的方法。

本发明具有以下有益效果：本发明通过对无人机在使用过程中的home位置坐标、决定返航位置坐标以及实际返航位置坐标的标定，结合其盘旋及横滚的特性，制定出一套科学合理的返航路径，从而精确地控制无人机超视距丢gps后返航到home位置。

附图说明

为了更清楚地说明本发明实施例或技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图，其中：

图1是本发明一种控制无人机超视距丢gps后返航到home位置的方法的原理示意图。

具体实施方式

下面将对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。

参阅图1，图1是本发明一种控制无人机超视距丢gps后返航到home位置的方法的原理示意图。本发明一种控制无人机超视距丢gps后返航到home位置的方法包括以下步骤：

步骤一：标定home位置的坐标p0；

home位置即为用户希望无人机返回时所到达的位置或区域。

步骤二：在无人机丢gps后的预设时间内，利用惯导估算其决定返航的位置坐标p1、返航速度v以及无人机此刻的航向信息h0

本实施例中，无人机丢gps后的预设时间为5秒-10秒。

本实施例中，获得坐标p1后，p1与p0之间的连线即为航向h0，本实施例中，航向h0为相对于正北方向的航向，下同。

步骤三：根据home位置的坐标p0、决定返航的位置坐标p1、返航速度v和预设的无人机盘旋半径r，获取无人机实际返航的位置坐标p2及无人机横滚的姿态角以及坐标p1和p0之间的连线与坐标p2和p0之间的连线的夹角β

具体的，通过速度v和飞机的预设的盘旋半径r，求出飞机盘旋需要的向心加速度ac；

再通过向心加速度ac求出飞机盘旋需要的roll(横滚)的姿态角

本实施例中，预设为p2与p0之间的连线与盘旋的圆相切，当飞机的盘旋方向确定时，实际返航的位置坐标p2是唯一确定的。在已知p0、p1和p2的坐标值和r值的前提下，可以求出p2与p0之间的距离s1,p1与p2之间的距离s2，p1与p0之间的距离s0，根据三角形三边s0、s1和s2，可以求出坐标p1和p0之间的连线与坐标p2和p0之间的连线的夹角β。

步骤四：根据决定返航时的航向信息h0与夹角β，获取无人机实际返航时的航向信息h1

本实施例中，h1与h0之间的关系式为：

当飞机被预设为逆时针盘旋时，h1＝h0+β；

当飞机被预设为顺时针盘旋时，h1＝h0-β。

步骤五：根据p2和p0之间的距离以及飞机返航的速度v，获取无人机的返航时间t

本实施例中，考虑到无人机实际飞行的航向不可能一直保持h1航向，预设一时间补偿系数ζ，ζ的取值范围为1-1.5；

通过以下公式计算获取无人机的返航时间t：

步骤六：命令无人机盘旋至p2位置时，沿航向h1以横滚姿态角的方式飞行时间t后，即返航到home位置

本实施例中，考虑到无人机实际飞行的航向不可能一直保持h1航向，横滚姿态角需要考虑航向偏差，具体计算公式如下：

将飞机当前航向记为hn，

获取航向偏差δhn，计算公式为：δhn＝hn-h1，

获取无人机的径向加速度ar，计算公式为：

获取无人机的横滚姿态角计算公式为：

本发明还提供了一种无人机控制装置，包括：处理器、存储器以及通信电路，所述处理器耦接所述存储器和所述通信电路；所述存储器存储有程序数据的信息，所述通信电路用于信息传输，所述处理器在工作时执行所述程序数据以实现上述任一所述一种控制无人机超视距丢gps后返航到home位置的方法。无人机集体返航到home位置的方法前述已详细描述，此处不再赘述。

本发明具有以下有益效果：本发明通过对无人机在使用过程中的home位置坐标、决定返航位置坐标以及实际返航位置坐标的标定，结合其盘旋及横滚的特性，制定出一套科学合理的返航路径，从而精确地控制无人机超视距丢gps后返航到home位置。

以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书内容所作的等效结构或等效流程变换，或直接或间接运用在其它相关的技术领域，均同理包括在本发明的专利保护范围内。