CN109782789B - 一种无人机在卫星导航数据失效后的安全飞行控制方法 - Google Patents
一种无人机在卫星导航数据失效后的安全飞行控制方法 Download PDFInfo
- Publication number
- CN109782789B CN109782789B CN201910239285.7A CN201910239285A CN109782789B CN 109782789 B CN109782789 B CN 109782789B CN 201910239285 A CN201910239285 A CN 201910239285A CN 109782789 B CN109782789 B CN 109782789B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- satellite positioning
- flight
- latitude
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人机在卫星导航数据失效后的安全飞行控制方法,包括:在无人机的机载飞行控制器中存储预设航线和地面操控点的位置信息(x0,y0);无人机在飞行过程中实时接收卫星定位数据,如果在t秒内连续没有收到卫星定位数据,则查找无人机接收到的最后一组卫星定位数据(xm,ym),利用无人机在最后一组卫星定位数据时刻的航向角ψ、倾斜角γ和飞行速度v,推算无人机t秒后的位置信息(xN,yN),将(xN,yN)与(x0,y0)连接形成新的定向航线L,计算定向航线L的航向角ψm,使无人机按照航向角ψm向地面操控点定向飞行。本发明使无人机在卫星导航数据失效后,仍然可以安全返回地面操控点,有效提高了无人机飞行的安全性和可靠性。
Description
技术领域
本发明涉及无人机的飞行控制技术领域,尤其涉及一种无人机在卫星导航数据失效后的安全飞行控制方法。
背景技术
无人机在程序飞行控制中,飞行控制器已存放了程控飞行的航路点坐标,航路点之间的连线即为预设航路,程控飞行即是通过比较无人机的实时位置与航路的偏差控制并修正无人机,保持无人机的飞行轨迹与预设航路一致。无人机的实时位置坐标(也称位置定位导航信息)通常是由卫星定位接收机提供,因此,程序控制中卫星定位导航数据至关重要,如果卫星定位导航数据失效,必然使无人机无法按照程序飞行,而且出现地面人员无法得知无人机的具***置,从而会导致无人机的丢失,发生飞行事故。在实际工作中,无人机经常受到来自地理环境以及周边电磁环境的影响,而出现卫星定位接收机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赤道为地球赤道半径,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/π。
本实施例中,首先利用无人机的最后一组卫星定位数据(xm,ym)、无人机从(xm,ym)飞向位置递推点(xN,yN)时的转弯半径R,以及(xm,ym)和转弯圆圆心(x’,y’)的连线与正北方向夹角,获取无人机从(xm,ym)飞向(xN,yN)时转弯圆的圆心坐标(x’,y’),然后利用转弯圆的圆心坐标(x’,y’)、无人机从(xm,ym)飞向位置递推点(xN,yN)时的转弯半径R,以及(x’,y’)和(xN,yN)的连线与正北方向夹角,获取无人机位置递推点的坐标(xN,yN)。其中,无人机从(xm,ym)飞向位置递推点(xN,yN)时的转弯半径R,既是(xm,ym)和(x’,y’)之间的距离,也是(xN,yN)和(x’,y’)之间的距离。
本发明采用位置递推算法和定向飞行控制,有效保证了卫星导航数据失效后,无人机仍然可以安全返回地面操控点附近开伞回收,提高了无人机飞行的安全性和可靠性。
Claims (3)
1.一种无人机在卫星导航数据失效后的安全飞行控制方法,其特征在于,包括:
在无人机的机载飞行控制器中存储预设航线和地面操控点的位置坐标(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/(g tan(γ));
式中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/π。
2.根据权利要求1所述的一种无人机在卫星导航数据失效后的安全飞行控制方法,其特征在于:所述无人机在飞行过程中采用两组卫星定位接收机分别接收卫星定位数据,如果在t秒内两个卫星定位接收机均连续没有收到卫星定位数据,则认为卫星定位数据失效。
3.根据权利要求1所述的一种无人机在卫星导航数据失效后的安全飞行控制方法,其特征在于:所述t值为5秒。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910239285.7A CN109782789B (zh) | 2019-03-27 | 2019-03-27 | 一种无人机在卫星导航数据失效后的安全飞行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910239285.7A CN109782789B (zh) | 2019-03-27 | 2019-03-27 | 一种无人机在卫星导航数据失效后的安全飞行控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109782789A CN109782789A (zh) | 2019-05-21 |
CN109782789B true CN109782789B (zh) | 2022-03-04 |
Family
ID=66490939
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910239285.7A Active CN109782789B (zh) | 2019-03-27 | 2019-03-27 | 一种无人机在卫星导航数据失效后的安全飞行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109782789B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111580559A (zh) * | 2020-05-29 | 2020-08-25 | 杭州今奥信息科技股份有限公司 | 一种无人飞行器防丢失方法和控制*** |
CN112000118B (zh) * | 2020-08-21 | 2023-01-31 | 深圳市道通智能航空技术股份有限公司 | 一种无人机保护方法、装置及无人机 |
CN112770330B (zh) * | 2020-12-31 | 2022-10-21 | 河南机电职业学院 | 一种无人机群区域无线覆盖部署方法 |
CN115164901B (zh) * | 2022-07-06 | 2023-04-14 | 河南工业贸易职业学院 | 无人机导航方法 |
CN116453378B (zh) * | 2023-06-16 | 2023-09-08 | 陕西德鑫智能科技有限公司 | 无人机航段交接切换方法及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6456906B1 (en) * | 1999-11-18 | 2002-09-24 | Trimble Navigation, Ltd | Satellite positioning-based guidance system that utilizes simulated inertial navigation system |
CN103616665A (zh) * | 2013-12-17 | 2014-03-05 | 中国航天空气动力技术研究院 | 一种利用通用照射源的无人机无源定位*** |
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
CN106646569A (zh) * | 2016-11-18 | 2017-05-10 | 华为技术有限公司 | 一种导航定位方法及设备 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110257882A1 (en) * | 2010-04-15 | 2011-10-20 | Mcburney Paul W | Road map feedback server for tightly coupled gps and dead reckoning vehicle navigation |
-
2019
- 2019-03-27 CN CN201910239285.7A patent/CN109782789B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6456906B1 (en) * | 1999-11-18 | 2002-09-24 | Trimble Navigation, Ltd | Satellite positioning-based guidance system that utilizes simulated inertial navigation system |
CN103616665A (zh) * | 2013-12-17 | 2014-03-05 | 中国航天空气动力技术研究院 | 一种利用通用照射源的无人机无源定位*** |
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
CN106646569A (zh) * | 2016-11-18 | 2017-05-10 | 华为技术有限公司 | 一种导航定位方法及设备 |
Non-Patent Citations (1)
Title |
---|
小型无人机航位推算定位算法研究与误差分析;谭雁英等;《火力与指挥控制》;20070515;第32卷(第05期);8-11、15 * |
Also Published As
Publication number | Publication date |
---|---|
CN109782789A (zh) | 2019-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109782789B (zh) | 一种无人机在卫星导航数据失效后的安全飞行控制方法 | |
ES2397546T3 (es) | Control de aproximación de precisión | |
CN104503466B (zh) | 一种微小型无人机导航装置 | |
US20190206265A1 (en) | Method and apparatus for target relative guidance | |
CN111650958B (zh) | 一种固定翼无人机起飞段切入航路点的在线路径规划方法 | |
JP6360744B2 (ja) | 乗り物を遠隔的に制御するための方法およびシステム | |
CN108255190B (zh) | 基于多传感器的精确着陆方法及使用该方法的系留无人机 | |
US20150253150A1 (en) | Device for determining navigation parameters of an aircraft during a landing phase | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN109708639B (zh) | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 | |
CN110967008A (zh) | 一种商用车自动驾驶全场景定位方法 | |
CN105928515B (zh) | 一种无人机导航*** | |
US11029707B2 (en) | Moving object, moving object control method, moving object control system, and moving object control program | |
US20120158237A1 (en) | Unmanned apparatus and method of driving the same | |
CN106927059A (zh) | 一种基于单目视觉的无人机降落方法及装置 | |
CN105242285A (zh) | 一种基于卫星通信的无人机导航数据被欺骗识别方法 | |
CN105403218B (zh) | 用于四旋翼无人机的俯仰角的地磁修正方法 | |
CN109084760A (zh) | 一种楼宇间导航*** | |
JP2020149640A (ja) | 飛行システム及び着陸制御方法 | |
JP3852842B2 (ja) | 飛翔体の位置姿勢計測装置 | |
JP2022029823A (ja) | 無人飛行体の制御システム、及び無人飛行体の制御方法 | |
CN109506662B (zh) | 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置 | |
CN113624235A (zh) | 一种无人机实时动态调整导航路径的方法 | |
CN108254771A (zh) | 系留无人机跟随车载平台方法及使用该方法的系留无人机 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |