[发明专利]一种伞降式无人机遥控中断后自主返航回收控制方法

说明书

本发明涉及一种伞降式无人机遥控中断后自主返航回收控制方法，无人机起飞前，向无人机装定预定回收点的纬度、经度坐标以及遥控中断累积时间门限，根据这些确定半径；启动无人机自主返航控制后，计算失控点到预定回收点的方位角和距离，根据方位角和距离计算相交点的位置，根据相交点的位置计算风向，然后根据估计所得的风向确定回收使用的航线。本发明实现无人机在遥控中断后，能够实现自主返航回收，并能根据回收区域风场进行在线重规划，调整回收进入方向，保证回收安全。

技术领域

本发明涉及无人机领域，更具体地说，是指一种伞降式无人机在遥控中断后自主返航并回收的控制方法。

背景技术

无人机在执行任务过程中，其与地面控制站之间是通过数据链进行数据交换的。由地面控制站发送给无人机的控制信号称为无人机遥控，由无人机发送给地面控制站的状态信号称为无人机遥测，遥控信号和遥测信号在无人机飞行过程中应一直保持通畅。

但由于无人机执行任务的地域地形影响，或数据链信号收到外界干扰，由地面控制站发送的遥控信号容易中断，这将导致无人机失去控制，轻则出现无人机任务失败，无法完成既定任务，重则会出现与空中其他飞行器相撞或坠毁的严重后果，因此在无人机遥控中断后，需要无人机能够自主的按照既定策略进行返航并回收。

伞降回收的无人机，在回收过程中要求逆风方向进行回收，以便无人机的回收降落伞能顺利打开，因此需要地面操纵手在回收阶段根据风场测量值通过遥控指令进行调整。若遥控出现中断，传统的自主返航方法是根据无人机起飞前装订好的返航路线进行飞行，并在指定位置打开降落伞实施回收，这种方式过分依赖无人机起飞前的任务规划，无人机则无法根据回收区的实时风场信息选择逆风方向作为进入角度，这将可能导致无人机开伞失败，造成飞机坠毁的事故，因此需要一种能根据回收场区风向在线调整进入角度的回收方法来确保返航回收的安全性。

发明内容

要解决的技术问题

为了避免现有技术的不足之处，本发明提出一种伞降式无人机遥控中断后自主返航回收控制方法，实现无人机在遥控中断后，能够实现自主返航回收，并能根据回收区域风场进行在线重规划，调整回收进入方向，保证回收安全。

技术方案

一种伞降式无人机遥控中断后自主返航回收控制方法，其特征在于步骤如下：

步骤1：无人机起飞前，向无人机装定预定回收点P的纬度、经度坐标(B_P,L_P)以及遥控中断累积时间门限T，无人机在P点执行打开降落伞操作进行回收，P点的选择应满足以P点为圆心，以R为半径的圆形空域范围内没有高于回收高度H_t的障碍物，将该圆形空域范围定义为回收区；所述的半径R应不小于4倍的无人机最小转弯半径，根据以下公式确定：

其中，V为巡航速度的平均值、γ_max为无人机转弯时的最大倾斜角，g为重力加速度；

步骤2：无人机在空中飞行过程中，出现遥控中断后开始计时，遥控中断累积时间记为T_d，若T_d≥T时，启动无人机自主返航控制，若计时累积期间出现遥控恢复，则将T_d置为0，当出现遥控再次中断后，重新开始计时；

步骤3：启动无人机自主返航控制后，将该时刻无人机当前纬度、经度(B_O,L_O)记为O点，将O点作为返航航线的起点，将预定回收点P作为返航航线的终点，控制无人机沿虚拟航线OP飞往P点；

步骤4：根据高斯坐标转换公式，将O点坐标与P点坐标转换为平面直角坐标下的位置(X_O,Y_O)和(X_P,Y_P)，计算O点到P点的方位角θ及O点到P点的距离D：