一种无人机在卫星导航数据失效后的安全飞行控制方法技术

本发明专利技术公开了一种无人机在卫星导航数据失效后的安全飞行控制方法，包括：在无人机的机载飞行控制器中存储预设航线和地面操控点的位置信息（x0,y0）；无人机在飞行过程中实时接收卫星定位数据，如果在t秒内连续没有收到卫星定位数据，则查找无人机接收到的最后一组卫星定位数据（xm，ym），利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v，推算无人机t秒后的位置信息（xN，yN），将（xN，yN）与（x0，y0）连接形成新的定向航线L，计算定向航线L的航向角ψm，使无人机按照航向角ψm向地面操控点定向飞行。本发明专利技术使无人机在卫星导航数据失效后，仍然可以安全返回地面操控点，有效提高了无人机飞行的安全性和可靠性。

A Safe Flight Control Method for UAV after Failure of Satellite Navigation Data

The invention discloses a safe flight control method for UAV after the failure of satellite navigation data, which includes: storing the position information of preset flight path and ground control point (x0, y0) in the UAV's airborne flight controller; receiving the satellite positioning data in real time during the flight process of UAV, and searching for the UAV to receive the satellite positioning data if it has not received the satellite positioning data continuously in t seconds. The last group of satellite positioning data (xm, ym), using the heading angle_, tilt angle gamma and flight speed V of the UAV at the last set of satellite positioning data, calculates the position information (xN, yN) of the UAV after t seconds, connects (xN, yN) with (x0, y0) to form a new directional route L, calculates the heading angle_m of the directional route L, and makes the UAV operate to the ground according to the heading angle_m. Control point directional flight. The invention enables the UAV to return to the ground control point safely after the failure of the satellite navigation data, and effectively improves the safety and reliability of the UAV flight.

【技术实现步骤摘要】
一种无人机在卫星导航数据失效后的安全飞行控制方法
本专利技术涉及无人机的飞行控制
，尤其涉及一种无人机在卫星导航数据失效后的安全飞行控制方法。
技术介绍
无人机在程序飞行控制中，飞行控制器已存放了程控飞行的航路点坐标，航路点之间的连线即为预设航路，程控飞行即是通过比较无人机的实时位置与航路的偏差控制并修正无人机，保持无人机的飞行轨迹与预设航路一致。无人机的实时位置坐标(也称位置定位导航信息)通常是由卫星定位接收机提供，因此，程序控制中卫星定位导航数据至关重要，如果卫星定位导航数据失效，必然使无人机无法按照程序飞行，而且出现地面人员无法得知无人机的具体位置，从而会导致无人机的丢失，发生飞行事故。在实际工作中，无人机经常受到来自地理环境以及周边电磁环境的影响，而出现卫星定位接收机GPS定位失效的情况，如何保证这种情况下无人机飞行安全成为重要课题。
技术实现思路
本专利技术的目的在于提供一种无人机在卫星导航数据失效后的安全飞行控制方法，能够保证卫星导航数据失效后，无人机仍然可以安全返回地面操控点附近开伞回收。为实现上述目的，本专利技术采用的技术方案是：一种无人机在卫星导航数据失效后的安全飞行控制方法，包括：在无人机的机载飞行控制器中存储预设航线和地面操控点的位置坐标(x0，y0)；无人机在飞行过程中实时接收卫星定位数据，如果在t秒内连续没有收到卫星定位数据，则认为卫星定位数据失效；查找无人机接收到的最后一组卫星定位数据(xm，ym)，利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v，推算无人机t秒后的位置坐标(xN，yN)，将(xN，yN)与(x0，y0)连接形成新的定向航线L，计算定向航线L的航向角ψm，使无人机按照航向角ψm向地面操控点定向飞行。推算无人机t秒后的位置坐标(xN，yN)时，包括以下步骤：(1)计算无人机从(xm，ym)飞向(xN，yN)时的转弯半径R：R＝v2/(gtan(γ))；式中g为重力加速度，g＝9.8米/秒；(2)计算无人机从(xm，ym)飞向(xN，yN)时转弯圆的圆心坐标(x’，y’)：纬度ym处的地球半径ecm为ecm＝R两极+(R赤道－R两极)×(90－ym)/90；式中R赤道为地球赤道半径，R两极为地球两极半径，R赤道＝6378137m，R两极＝6356725m；纬度ym处的纬线圈半径edm为edm＝ecm×cos(ym×π/180)；(xm，ym)和(x’，y’)两点间经度方向上的距离差dxm为dxm＝R×1000×sin(αm×π/180)；式中αm为(xm，ym)和(x’，y’)的连线与正北方向夹角，若ψ朝左为逆时针，则αm＝ψ－90°，若ψ朝右为顺时针，则αm＝ψ+90°；(xm，ym)和(x’，y’)两点间纬度方向上的距离差dym为dym＝R×1000×cos(αm×π/180)；转弯圆的圆心经度x’为x’＝(dxm/edm+xm×π/180)×180/π；转弯圆的圆心纬度y’为y’＝(dym/ecm+ym×π/180)×180/π；(3)计算(xm，ym)和(x’，y’)的连线与(xN，yN)和(x’，y’)的连线之间的夹角β：β＝5v/R×180/π；(4)计算无人机位置递推点的坐标(xN，yN)：纬度y’处的地球半径ec’为ec’＝R两极+(R赤道－R两极)×(90－y’)/90；纬度y’处的纬线圈半径ed’为ed’＝ec’×cos(y’×π/180)；(x’，y’)和(xN，yN)两点间经度方向上的距离差dx’为dx’＝R×1000×sin(α’×π/180)；式中α’为(x’，y’)和(xN，yN)的连线与正北方向夹角，若ψ朝左为逆时针，则α’＝ψ－90°+β，若ψ朝右为顺时针，则α’＝ψ+90°－β；(x’，y’)和(xN，yN)两点间纬度方向上的距离差dy’为dy’＝R×1000×cos(α’×π/180)；位置递推点的经度xN为xN＝(dx’/ed’+x’×π/180)×180/π；位置递推点的纬度yN为yN＝(dy’/ec’+y’×π/180)×180/π。所述无人机在飞行过程中采用两组卫星定位接收机分别接收卫星定位数据，如果在t秒内两个卫星定位接收机均连续没有收到卫星定位数据，则认为卫星定位数据失效。所述t值为5秒。本专利技术在判定卫星定位失效后，根据无人机接收的最后一组位置坐标，以及当时无人机自身的航向角ψ、倾斜角γ和飞行速度v，推算数秒后无人机的位置，进而控制无人向地面操控点定向飞行，有效提高了无人机飞行的安全性和可靠性。附图说明图1为本专利技术控制无人机在定位失效后安全返回的示意图。具体实施方式为使本专利技术的目的、技术方案和优点更加清楚，下面结合具体实施例对本专利技术的技术方案进行清楚、完整的描述。显然，所描述的实施例仅是部分实施例，而不是全部的实施例。基于所描述的实施例，本领域普通技术人员在无需创造性劳动的前提下所获得其他所有实施例，都在本专利技术的保护范围之内。在无人机飞行前，将规划的预设路线以及地面操控点的位置坐标(x0，y0)发送并存放至无人机的机载飞行控制器中。无人机上装载有垂直陀螺仪(或惯性导航姿态测量仪)测量无人机的俯仰角θ、倾斜角γ；高度传感器(一般是气压高度传感器)测量无人机的飞行高度H；航向传感器(一般是磁罗盘航向传感器)测量无人机的机头指向即航向角ψ；速度传感器测量无人机的飞行速度v；GPS卫星定位接收机输出无人机的实时位置。无人机在飞行过程中实时接收卫星定位数据，其中，GPS卫星定位接收机的接收频率一般是4～10Hz，即每秒更新4～10次位置信息。为增加可靠性，可采用两个GPS卫星定位接收机分别独立接收无人机的卫星定位数据。无人机的机载飞行控制器实时监控GPS卫星定位接收机送来的定位更新数据，如果在t秒内两个卫星定位接收机均连续没有收到卫星定位数据，则认为卫星定位数据失效，t值可取5秒。如图1所示，控制无人机在定位失效后安全返回时，首先查找无人机接收到的最后一组卫星定位数据(xm，ym)，利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v，推算无人机t秒后的位置信息(xN，yN)，将(xN，yN)与(x0，y0)连接形成新的定向航线L，计算定向航线L的航向角ψm，则无人机进入定向飞行控制模态，按照航向角ψm向地面操控点定向飞行。尽管地面操控点无法显示无人机的位置，即无法得知无人机的具体位置，但可以通过航向角显示窗口观察无人机的航向角是否朝着ψm的方向飞行，如果无人机的航向角是朝着ψm方向飞行，此时卫星失效控制程序正在执行。地面操控点人员随后可以看见或听见无人机逐渐朝操控点飞过来，当地面人员观察并发现无人机后，则可以转遥控飞行模态，遥控无人机安全回收。具体的，根据无人机的最后一组卫星定位数据(xm，ym)，推算无人机t秒后的位置信息(xN，,yN)，包括以下步骤：(1)计算无人机从(xm，ym)飞向(xN，yN)时的转弯半径R：R＝v2/(gtan(γ))；式中g为重力加速度，g＝9.8米/秒；(2)计算无人机从(xm，ym)飞向(xN，yN)时转弯圆的圆心坐标(x’，y’)：纬度ym处的地球半径ecm为ecm＝R两极+(R赤道－R两极)×(90－ym)/90；式中R赤道为地球赤道半径，本文档来自技高网...

【技术保护点】
1.一种无人机在卫星导航数据失效后的安全飞行控制方法，其特征在于，包括：在无人机的机载飞行控制器中存储预设航线和地面操控点的位置坐标(x0，y0)；无人机在飞行过程中实时接收卫星定位数据，如果在t秒内连续没有收到卫星定位数据，则认为卫星定位数据失效；查找无人机接收到的最后一组卫星定位数据(xm，ym)，利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v，推算无人机t秒后的位置坐标(xN，yN)，将(xN，yN)与(x0，y0)连接形成新的定向航线L，计算定向航线L的航向角ψm，使无人机按照航向角ψm向地面操控点定向飞行。

【技术特征摘要】
1.一种无人机在卫星导航数据失效后的安全飞行控制方法，其特征在于，包括：在无人机的机载飞行控制器中存储预设航线和地面操控点的位置坐标(x0，y0)；无人机在飞行过程中实时接收卫星定位数据，如果在t秒内连续没有收到卫星定位数据，则认为卫星定位数据失效；查找无人机接收到的最后一组卫星定位数据(xm，ym)，利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v，推算无人机t秒后的位置坐标(xN，yN)，将(xN，yN)与(x0，y0)连接形成新的定向航线L，计算定向航线L的航向角ψm，使无人机按照航向角ψm向地面操控点定向飞行。2.根据权利要求1所述的一种无人机在卫星导航数据失效后的安全飞行控制方法，其特征在于，推算无人机t秒后的位置坐标(xN，yN)时，包括以下步骤：(1)计算无人机从(xm，ym)飞向(xN，yN)时的转弯半径R：R＝v2/(gtan(γ))；式中g为重力加速度，g＝9.8米/秒；(2)计算无人机从(xm，ym)飞向(xN，yN)时转弯圆的圆心坐标(x’，y’)：纬度ym处的地球半径ecm为ecm＝R两极+(R赤道－R两极)×(90－ym)/90；式中R赤道为地球赤道半径，R两极为地球两极半径，R赤道＝6378137m，R两极＝6356725m；纬度ym处的纬线圈半径edm为edm＝ecm×cos(ym×π/180)；(xm，ym)和(x’，y’)两点间经度方向上的距离差dxm为dxm＝R×1000×sin(αm×π/180)；式中αm为(xm，ym)和(x’，y’)的连线与正北方向夹角，若ψ朝左为逆时针，则αm＝ψ－90°，若ψ朝右为顺时针，则αm＝ψ+90°；(xm，ym)和(x’...

【专利技术属性】
技术研发人员：许智辉，陈海峰，赵鑫，许寿彭，付毅峰，化进科，崔睿，
申请(专利权)人：河南机电职业学院，郑州亚柏智能科技有限公司，河南省柏盛无人机工程技术研究院有限公司，
类型：发明
国别省市：河南,41