CN102506872A - 一种判定飞行航路偏离的方法 - Google Patents

一种判定飞行航路偏离的方法 Download PDF

Info

Publication number
CN102506872A
CN102506872A CN2011103855671A CN201110385567A CN102506872A CN 102506872 A CN102506872 A CN 102506872A CN 2011103855671 A CN2011103855671 A CN 2011103855671A CN 201110385567 A CN201110385567 A CN 201110385567A CN 102506872 A CN102506872 A CN 102506872A
Authority
CN
China
Prior art keywords
point
air route
angle
coordinates
route
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.)
Granted
Application number
CN2011103855671A
Other languages
English (en)
Other versions
CN102506872B (zh
Inventor
刘让国
彭会湘
李峰
韦二龙
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
CETC 54 Research Institute
Original Assignee
CETC 54 Research Institute
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by CETC 54 Research Institute filed Critical CETC 54 Research Institute
Priority to CN201110385567.1A priority Critical patent/CN102506872B/zh
Publication of CN102506872A publication Critical patent/CN102506872A/zh
Application granted granted Critical
Publication of CN102506872B publication Critical patent/CN102506872B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种判定飞行航路偏离的方法，它涉及航路规划领域中的判定空中航路偏离的应用技术，该方法通过大地坐标与空间直角坐标间的转换关系，将飞行器当前位置点大地坐标和航路位置点大地坐标转换为空间直角坐标，采用三维立体几何算法，逐段计算当前位置点和航路的最短距离处坐标，并将最短距离处坐标逆转换为大地坐标，然后通过计算两个大地坐标点间的水平距离和高差，判定是否在航路容许的偏差范围内。本发明具有算法精确、判定速度快、误差小、性能稳定可靠等特点，特别适用于空中航路偏离报警、飞行导航和监控、空域管理等应用领域。

Description

一种判定飞行航路偏离的方法
技术领域
本发明涉及航路规划领域中的一种判定飞行航路偏离的方法，特别适用于空中航路偏离报警、飞行导航和监控、空域管理等应用领域。
背景技术
随着技术的发展，空中飞行器数量快速增多，空域管理和飞行监控愈加重要，需要各飞行器沿着规划航路飞行。因此，航路偏离告警是重要考虑内容。而位置点及航路坐标一般为大地坐标，坐标间单位(经度和纬度采用度为单位，高度采用米为单位)不统一，不能直接用于计算。目前，空中航路偏离判定方法多采用和地面偏航判定类似的方法，将空中航线投影到地面，再转化为高斯直角坐标，进行判断。也有考虑时间有关性的判定方法，即根据指定时间是否到达指定位置进行判定。第一种方法在涉及航路跨高斯带时，计算误差较大，易造成虚假报警，且高度偏差还需另外计算，第二种方法适合执行应急任务时的特殊情况，难以普及应用。
发明内容
本发明所需解决的技术问题在于避免上述背景技术中的不足之处而提供一种基于空间直角坐标和三维立体几何算法的、与时间无关的判定空中航路偏离的方法。本发明具有算法简单易懂、可理解性强、易于实施的特点。
本发明所要解决的技术问题是由以下技术方案实现的：
一种判定飞行航路偏离的方法，其特征在于包括以下步骤：
(1)将大地坐标系中飞行器当前位置点P转换为空间直角坐标系中的位置点P′；
(2)将大地坐标系中航路位置点转换为空间直角坐标系中的航路位置点；
(3)取空间直角坐标中航路的两个连续位置点A和B；
(4)使用立体几何算法，分别计算P′、A、B三点间的空间距离，即空间三角形P′AB三条边的长度；
(5)三条边中若有长度为0的边，则重合点作为最近位置点Pv，然后进入步骤(9)；否则，进入步骤(6)；
(6)若P′、A、B三点在一条直线上，根据三点间的位置关系，计算最近位置点Pv，然后进入步骤(9)；否则，进入步骤(7)；
(7)根据三角形余弦定理，计算角∠A和角∠B大小；
(8)若角∠A、角∠B中有一为直角或钝角，则相应点作为最近位置点Pv；若角∠A、角∠B均为锐角，则利用三角函数计算P′点在线段AB上的垂足M，作为最近位置点Pv；
(9)将航路最近位置点的空间直角坐标Pv转换为大地坐标Pv′；
(10)在大地坐标系下，计算当前位置点P和航路最近位置点Pv′间的大地水平距离和高差；
(11)判定水平距离和高差是否在允许的偏差范围内，若均在容许范围内，则认为没有偏航；否则，重复步骤(3)至步骤(11)，直至航路所有位置点遍历完毕，若当前位置点不在任一段航路容许范围内，则判定为偏离了航线。
其中，步骤(4)至步骤(8)中的航路最近位置点计算，采用的是空间直角坐标和立体几何算法。
其中，步骤(10)中的计算水平距离和高差，是在大地坐标系下进行的。
其中，步骤(1)中的大地坐标(L、B、H，分别为大地经度、大地纬度、大地高)换算为空间直角坐标(X、Y、Z，分别为空间三维直角坐标分量)的公式为：X＝(N+H)cosB cosL，Y＝(N+H)cosB sinL，Z＝[N(1-e2)+H]sinB；步骤(9)中的空间直角坐标换算为大地坐标的公式为：L＝arctan(Y/X)，B＝arctan[Z/(X2+Y2)*(1-e2N(N+H)-1]，H＝(X2+Y2)0.5/cosB-N。其中，e为椭球的第一偏心率，e2＝(a2-b2)/a2，N为卯酉圈曲率半径，N＝a/(1-e2sin2B)0.5，a为椭球长半轴长，b为椭球短半轴长。
本发明与背景技术相比具有如下优点：
1、本发明避免了航路坐标跨高斯带的影响，利用空间直角坐标和三维立体几何算法，进行最近位置点计算。
2、本发明具有时间无关性，适用于大多数情况下的航路偏离判定。即不论何时，只要在航路容许的偏差范围内，则认为没有偏航。
3、本发明具有算法精确、判定速度快、判定误差小的特点。采用三维坐标和立体几何算法，没有近似处理，同时将水平距离和高差求出，避免了高度偏离的额外计算。
4、本发明还具有算法简便易懂，性能稳定可靠，适用范围广等优点。
附图说明
图1是本发明使用的空间直角坐标系示意图。
其中，O为坐标原点(椭球中心)，Z轴与椭球的旋转轴一致并指向北极，X轴位于起始大地子午面和赤道的交线上，Y轴与X轴、Z轴构成右手坐标系。
图2是本发明中最近位置点计算时的一种示意图。
其中，X、Y、Z分别为空间直角坐标系的三个坐标轴，P′为当前位置点，A、B为航路中两个连续的位置点，Pv为计算出的最近位置点，L1为P′到点A的空间距离，L2为P′到点B的空间距离，L3为点A到点B的空间距离。
具体实施方式
下面，结合图1和图2对本发明作进一步说明。
一种判定飞行航路偏离的方法，该方法原理为将飞行器当前位置点大地坐标和航路位置点大地坐标转换为空间直角坐标，采用三维立体几何算法，逐段计算当前位置点和航路的最短距离处坐标，并将最短距离处坐标逆转换为大地坐标，然后通过计算两个大地坐标点间的水平距离和高差，判定是否在航路容许的偏差范围内。
本发明包括步骤：
(1)将大地坐标系中飞行器当前位置点P转换为空间直角坐标系中的位置点P′。根据空间直角坐标(XYZ)与大地坐标(LBH)的转换公式，将当前位置点的大地坐标，记为P(L，B，H)，转换为空间直角坐标，记为P′(X，Y，Z)。
(2)将大地坐标系中航路位置点转换为空间直角坐标系中的航路位置点，记为集合R′＝{p1，p2，……，pn}。
(3)取空间直角坐标中航路的两个连续位置点A和B，记为A＝pi，B＝pj(1≤i，j≤n)。
(4)使用立体几何算法，分别计算P′、A、B三点间的空间距离，即空间三角形P′AB三条边的长度。分别记为L1(P′-＞pi)、L2(P′-＞pj)和L3(pi-＞pi)。
(5)三条边中若有长度为0的边，则重合点作为最近位置点Pv，然后进入步骤(9)；否则，进入步骤(6)。即，若L1＝0，则最近点Pv＝pi；若L2＝0，则最近点Pv＝pj；若L3＝0，则最近点为pi或pj均可。
(6)若P′、A、B三点在一条直线上，根据三点间的位置关系，计算最近位置点Pv，然后进入步骤(9)；否则，进入步骤(7)。若P′在线段AB的左延长线上，则Pv＝pi；在线段AB的右延长线上，则Pv＝pj；若P′在线段AB上，Pv＝P′。
(7)根据三角形余弦定理，计算角∠A和角∠B大小。已知三条边长分别为L1、L2和L3，则角∠A＝acos((L12+L32-L22)/(2*L1*L3))，角∠B＝acos((L22+L32-L12)/(2*L2*L3))。
(8)若角∠A、角∠B中有一为直角或钝角，则相应点作为最近位置点Pv；若角∠A、角∠B均为锐角，则利用三角函数计算P′点在线段AB上的垂足M，作为最近位置点Pv。
如根据角∠A计算垂足坐标M，则M.x＝pi.x+(pj.x-pi.x)*L1*cosA/L3，M.y＝pi.y+(pj.y-pi.y)*L1*cosA/L3，M.z＝pi.z+(pj.z-pi.z)*L1*cosA/L3，令Pv＝M。
(9)将航路最近位置点的空间直角坐标Pv转换为大地坐标Pv′。根据空间直角坐标(XYZ)与大地坐标(LBH)的转换公式，将最近位置点的空间直角坐标，Pv(X，Y，Z)，转换为大地坐标Pv′(L，B，H)。
(10)在大地坐标系下，计算当前位置点P和航路最近位置点Pv′间的大地水平距离和高差。
(11)判定水平距离和高差是否在允许的偏差范围内，若均在容许范围内，则认为没有偏航；否则，重复步骤(3)至步骤(11)，直至航路所有位置点遍历完毕，若当前位置点不在任一段航路容许范围内，则判定为偏离了航线。
其中，步骤(1)中的大地坐标(L、B、H，分别为大地经度、大地纬度、大地高)换算为空间直角坐标(X、Y、Z，分别为空间三维直角坐标分量)的公式为：X＝(N+H)cosB cosL，Y＝(N+H)cosBsinL，Z＝[N(1-e2)+H]sinB；步骤(9)中的空间直角坐标换算为大地坐标的公式为：L＝arctan(Y/X)，B＝arctan[Z/(X2+Y2)*(1-e2N(N+H))-1]，H＝(X2+Y2)0.5/cosB-N。其中，e为椭球的第一偏心率，e2＝(a2-b2)/a2，N为卯酉圈曲率半径，N＝a/(1-e2sin2B)0.5，a为椭球长半轴长，b为椭球短半轴长。

Claims (3)

1.一种判定飞行航路偏离的方法，其特征在于包括以下步骤：
(1)将大地坐标系中飞行器当前位置点P转换为空间直角坐标系中的位置点P′；
(2)将大地坐标系中航路位置点转换为空间直角坐标系中的航路位置点；
(3)取空间直角坐标中航路的两个连续位置点A和B；
(4)使用立体几何算法，分别计算P′、A、B三点间的空间距离，即空间三角形P′AB三条边的长度；
(5)三条边中若有长度为0的边，则重合点作为最近位置点Pv，然后进入步骤(9)；否则，进入步骤(6)；
(6)若P′、A、B三点在一条直线上，根据三点间的位置关系，计算最近位置点Pv，然后进入步骤(9)；否则，进入步骤(7)；
(7)根据三角形余弦定理，计算角∠A和角∠B大小；
(8)若角∠A、角∠B中有一为直角或钝角，则相应点作为最近位置点Pv；若角∠A、角∠B均为锐角，则利用三角函数计算P′点在线段AB上的垂足M，作为最近位置点Pv；
(9)将航路最近位置点的空间直角坐标Pv转换为大地坐标Pv′；
(10)在大地坐标系下，计算当前位置点P和航路最近位置点Pv′间的大地水平距离和高差；
(11)判定水平距离和高差是否在允许的偏差范围内，若均在容许范围内，则认为没有偏航；否则，重复步骤(3)至步骤(11)，直至航路所有位置点遍历完毕，若当前位置点不在任一段航路容许范围内，则判定为偏离了航线。
2.根据权利要求1所述的一种判定飞行航路偏离的方法，其特征在于：步骤(4)至步骤(8)中的航路最近位置点计算，采用的是空间直角坐标和立体几何算法。
3.根据权利要求1所述的一种判定飞行航路偏离的方法，其特征在于：步骤(10)中的计算水平距离和高差，是在大地坐标系下进行的。
CN201110385567.1A 2011-11-28 2011-11-28 一种判定飞行航路偏离的方法 Active CN102506872B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110385567.1A CN102506872B (zh) 2011-11-28 2011-11-28 一种判定飞行航路偏离的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110385567.1A CN102506872B (zh) 2011-11-28 2011-11-28 一种判定飞行航路偏离的方法

Publications (2)

Publication Number Publication Date
CN102506872A true CN102506872A (zh) 2012-06-20
CN102506872B CN102506872B (zh) 2015-02-11

Family

ID=46218979

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110385567.1A Active CN102506872B (zh) 2011-11-28 2011-11-28 一种判定飞行航路偏离的方法

Country Status (1)

Country Link
CN (1) CN102506872B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103412575A (zh) * 2013-08-23 2013-11-27 无锡汉和航空技术有限公司 一种无人直升机航线控制、辅助控制装置
CN109960774A (zh) * 2019-02-13 2019-07-02 浩亚信息科技有限公司 一种目视飞行航线实时测算方法、电子设备、存储介质
CN109990793A (zh) * 2017-12-29 2019-07-09 杭州海康威视***技术有限公司 确定车辆偏航的方法、装置及计算机可读存储介质
CN110211376A (zh) * 2019-05-28 2019-09-06 成都谷辘信息技术有限公司 一种危险品运输车辆监控预警***
CN111121779A (zh) * 2019-12-06 2020-05-08 南京航空航天大学 一种无人机所处飞行区域的实时检测方法
CN112396872A (zh) * 2020-11-03 2021-02-23 海丰通航科技有限公司 一种基于计算机飞行计划cfp数据的飞机偏航判定方法、装置及存储介质
CN113112873A (zh) * 2021-03-29 2021-07-13 中琪华安(北京)科技有限公司 一种空域告警方法及装置
CN115273562A (zh) * 2022-07-27 2022-11-01 齐鲁空天信息研究院 通用航空低空通航飞行的一致性监控方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1234575A (zh) * 1997-12-15 1999-11-10 雷特翁公司 空中交通管制***
EP1243895A2 (en) * 2001-03-19 2002-09-25 Kabushiki Kaisha Toshiba Navigation assisting system, flight-route calculating method, and navigation assisting method
US20080306680A1 (en) * 2005-12-07 2008-12-11 Nicolas Marty Method for Determining the Horizontal Profile of a Flight Plan Complying with a Prescribed Vertical Flight Profile
GR1006243B (el) * 2007-11-26 2009-01-28 Γεωργιος Φουρλας Μεθοδος εντοπισμου αποκλισης πολιτικων αεροσκαφων απο το σχεδιο πτησης τους
CN102103803A (zh) * 2011-01-19 2011-06-22 南京莱斯信息技术股份有限公司 一种机场终端区航空器的监控方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1234575A (zh) * 1997-12-15 1999-11-10 雷特翁公司 空中交通管制***
EP1243895A2 (en) * 2001-03-19 2002-09-25 Kabushiki Kaisha Toshiba Navigation assisting system, flight-route calculating method, and navigation assisting method
US20080306680A1 (en) * 2005-12-07 2008-12-11 Nicolas Marty Method for Determining the Horizontal Profile of a Flight Plan Complying with a Prescribed Vertical Flight Profile
GR1006243B (el) * 2007-11-26 2009-01-28 Γεωργιος Φουρλας Μεθοδος εντοπισμου αποκλισης πολιτικων αεροσκαφων απο το σχεδιο πτησης τους
CN102103803A (zh) * 2011-01-19 2011-06-22 南京莱斯信息技术股份有限公司 一种机场终端区航空器的监控方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
周胜利等: "基于飞行数据的所需导航性能(RNP)侧向偏差分析", 《交通标准化》, no. 04, 31 December 2009 (2009-12-31) *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103412575A (zh) * 2013-08-23 2013-11-27 无锡汉和航空技术有限公司 一种无人直升机航线控制、辅助控制装置
CN103412575B (zh) * 2013-08-23 2017-03-01 无锡汉和航空技术有限公司 一种无人直升机航线控制装置
CN109990793A (zh) * 2017-12-29 2019-07-09 杭州海康威视***技术有限公司 确定车辆偏航的方法、装置及计算机可读存储介质
CN109960774A (zh) * 2019-02-13 2019-07-02 浩亚信息科技有限公司 一种目视飞行航线实时测算方法、电子设备、存储介质
CN110211376A (zh) * 2019-05-28 2019-09-06 成都谷辘信息技术有限公司 一种危险品运输车辆监控预警***
CN111121779A (zh) * 2019-12-06 2020-05-08 南京航空航天大学 一种无人机所处飞行区域的实时检测方法
CN111121779B (zh) * 2019-12-06 2022-04-08 南京航空航天大学 一种无人机所处飞行区域的实时检测方法
CN112396872A (zh) * 2020-11-03 2021-02-23 海丰通航科技有限公司 一种基于计算机飞行计划cfp数据的飞机偏航判定方法、装置及存储介质
CN113112873A (zh) * 2021-03-29 2021-07-13 中琪华安(北京)科技有限公司 一种空域告警方法及装置
CN115273562A (zh) * 2022-07-27 2022-11-01 齐鲁空天信息研究院 通用航空低空通航飞行的一致性监控方法

Also Published As

Publication number Publication date
CN102506872B (zh) 2015-02-11

Similar Documents

Publication Publication Date Title
CN102506872B (zh) 一种判定飞行航路偏离的方法
CN106767853B (zh) 一种基于多信息融合的无人驾驶车辆高精度定位方法
CN110709890B (zh) 地图数据修正方法及装置
RU2704614C1 (ru) Система управления полетом беспилотного летательного аппарата с дифференциальным позиционированием на основе сети cors
US10642284B1 (en) Location determination using ground structures
Kim et al. Lane map building and localization for automated driving using 2D laser rangefinder
CN108225320A (zh) 使用v2x、传感器和gnss信息的车辆定位***
CN105547297A (zh) 一种基于uwb定位***的室内定位方法
CN111123334B (zh) 一种极限工况下多车协同定位平台及定位方法
CN107153422B (zh) 飞机着陆***和方法
CN104428686A (zh) 用于获得车辆位置的方法和车辆
US20220107197A1 (en) Roadway information detection sensor device/system for autonomous vehicles
CN107765279B (zh) 一种融合惯性、卫星的车载定位定向瞄准***及瞄准方法
US11579628B2 (en) Method for localizing a vehicle
JP2013040886A (ja) 三次元点群計測方法、三次元点群計測プログラム
CN103344979A (zh) 一种旷野目标的无人机搜索定位方法
CN110441760B (zh) 一种基于先验地形图的大范围海底地形图拓展构图方法
CN112683260A (zh) 一种基于高精度地图和v2x的组合导航定位精度提升***及方法
CN105301621A (zh) 一种车辆定位装置及一种智能驾考***
CN113758482B (zh) 车辆导航定位方法、装置、基站、***及可读存储介质
CN115855041A (zh) 一种农业机器人定位方法、***及装置
CN105571593B (zh) 一种基于mls的地理位置信息获取方法
CN109633695A (zh) 一种无人机对卫导干扰机的主动定位方法
KR20200119092A (ko) 차량 및 차량의 위치 검출 방법
CN105758411A (zh) 一种基于车载摄像头提升车载gps定位精度的***和方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant