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

暂无

一种判定飞行航路偏离的方法 \n技术领域\n[0001] 本发明涉及航路规划领域中的一种判定飞行航路偏离的方法，特别适用于空中航路偏离报警、飞行导航和监控、空域管理等应用领域。\n背景技术\n[0002] 随着技术的发展，空中飞行器数量快速增多，空域管理和飞行监控愈加重要，需要各飞行器沿着规划航路飞行。因此，航路偏离告警是重要考虑内容。而位置点及航路坐标一般为大地坐标，坐标间单位(经度和纬度采用度为单位，高度采用米为单位)不统一，不能直接用于计算。目前，空中航路偏离判定方法多采用和地面偏航判定类似的方法，将空中航线投影到地面，再转化为高斯直角坐标，进行判断。也有考虑时间有关性的判定方法，即根据指定时间是否到达指定位置进行判定。第一种方法在涉及航路跨高斯带时，计算误差较大，易造成虚假报警，且高度偏差还需另外计算，第二种方法适合执行应急任务时的特殊情况，难以普及应用。\n发明内容\n[0003] 本发明所需解决的技术问题在于避免上述背景技术中的不足之处而提供一种基于空间直角坐标和三维立体几何算法的、与时间无关的判定空中航路偏离的方法。本发明具有算法简单易懂、可理解性强、易于实施的特点。\n[0004] 本发明所要解决的技术问题是由以下技术方案实现的：\n[0005] 一种判定飞行航路偏离的方法，其特征在于包括以下步骤：\n[0006] (1)将大地坐标系中飞行器当前位置点P转换为空间直角坐标系中的位置点P′；\n[0007] (2)将大地坐标系中航路位置点转换为空间直角坐标系中的航路位置点；\n[0008] (3)取空间直角坐标中航路的两个连续位置点A和B；\n[0009] (4)使用立体几何算法，分别计算P′、A、B三点间的空间距离，即空间三角形P′AB三条边的长度；\n[0010] (5)三条边中若有长度为0的边，则重合点作为最近位置点Pv，然后进入步骤(9)；\n否则，进入步骤(6)；\n[0011] (6)若P′、A、B三点在一条直线上，根据三点间的位置关系，计算最近位置点Pv，然后进入步骤(9)；否则，进入步骤(7)；其中，计算最近位置点Pv具体为：若P′在线段AB的左延长线上，则Pv就是A点；在线段AB的右延长线上，则Pv就是B点；若P′在线段AB上，Pv就是P′点；\n[0012] (7)根据三角形余弦定理，计算角∠A和角∠B大小；\n[0013] (8)若角∠A、角∠B中有一为直角或钝角，则相应点作为最近位置点Pv；若角∠A、角∠B均为锐角，则利用三角函数计算P′点在线段AB上的垂足M，作为最近位置点Pv；\n[0014] (9)将航路最近位置点的空间直角坐标Pv转换为大地坐标Pv′；\n[0015] (10)在大地坐标系下，计算当前位置点P和航路最近位置点Pv′间的大地水平距离和高差；\n[0016] (11)判定水平距离和高差是否在允许的偏差范围内，若均在容许范围内，则认为没有偏航；否则，重复步骤(3)至步骤(11)，直至航路所有位置点遍历完毕，若当前位置点不在任一段航路容许范围内，则判定为偏离了航线。\n[0017] 其中，步骤(4)至步骤(8)中的航路最近位置点计算，采用的是空间直角坐标和立体几何算法。\n[0018] 其中，步骤(10)中的计算水平距离和高差，是在大地坐标系下进行的。\n[0019] 其中，步骤(1)中的大地坐标(L、B、H，分别为大地经度、大地纬度、 大地高)换算为空间直角坐标(X、Y、Z、分别为空间三维直角坐标分量)的公式为：X=(N+H）cosB cosL，\n2\nY=(N+H）cosB sinL，Z=[N(1-e)+H]sinB；步骤(9)中的空间直角坐标换算为大地坐标的公\n２ ２ ２ -1 2 2 0.5\n式为：L=arctan(Y／X)，B=arctan[Ｚ／(Ｘ +Ｙ )*(１－e N(N+H) ]，H=(X+Y) ／\n2 2 2 2\ncosB-N。其中，e为椭球的第一偏心率，e=(a-b)／a，N为卯酉圈曲率半径，N=a／(１－\n2 2 0.5\nesinB) ，a为椭球长半轴长，b为椭球短半轴长。\n[0020] 本发明与背景技术相比具有如下优点：\n[0021] 1、本发明避免了航路坐标跨高斯带的影响，利用空间直角坐标和三维立体几何算法，进行最近位置点计算。\n[0022] 2、本发明具有时间无关性，适用于大多数情况下的航路偏离判定。即不论何时，只要在航路容许的偏差范围内，则认为没有偏航。\n[0023] 3、本发明具有算法精确、判定速度快、判定误差小的特点。采用三维坐标和立体几何算法，没有近似处理，同时将水平距离和高差求出，避免了高度偏离的额外计算。\n[0024] 4、本发明还具有算法简便易懂，性能稳定可靠，适用范围广等优点。\n附图说明\n[0025] 图1是本发明使用的空间直角坐标系示意图。\n[0026] 其中，O为坐标原点(椭球中心)，Z轴与椭球的旋转轴一致并指向北极，X轴位于起始大地子午面和赤道的交线上，Y轴与X轴、Z轴构成右手坐标系。\n[0027] 图2是本发明中最近位置点计算时的一种示意图。\n[0028] 其中，X、Y、Z分别为空间直角坐标系的三个坐标轴，P′为当前位置点，A、B为航路中两个连续的位置点，Pv为计算出的最近位置点，Ｌ１为P′到点A的空间距离，L2为P′到点B的空间距离，L3为点A到点B的空间距离。\n具体实施方式\n[0029] 下面，结合图1和图2对本发明作进一步说明。\n[0030] 一种判定飞行航路偏离的方法，该方法原理为将飞行器当前位置点大地坐标和航路位置点大地坐标转换为空间直角坐标，采用三维立体几何算法，逐段计算当前位置点和航路的最短距离处坐标，并将最短距离处坐标逆转换为大地坐标，然后通过计算两个大地坐标点间的水平距离和高差，判定是否在航路容许的偏差范围内。\n[0031] 本发明包括步骤：\n[0032] (1)将大地坐标系中飞行器当前位置点P转换为空间直角坐标系中的位置点P′。\n根据空间直角坐标(XYZ)与大地坐标(LＢＨ）的转换公式，将当前位置点的大地坐标，记为P(Ｌ，Ｂ，Ｈ），转换为空间直角坐标，记为P′(Ｘ，Ｙ，Ｚ）。\n[0033] (2)将大地坐标系中航路位置点转换为空间直角坐标系中的航路位置点，记为集合R′={p1，p2，……，pn}。\n[0034] (3)取空间直角坐标中航路的两个连续位置点A和B，记为A=pi，B=pj(1≤i，j≤n)。\n[0035] (4)使用立体几何算法，分别计算P′、A、B三点间的空间距离，即空间三角形P′AB三条边的长度。分别记为L1(P′-＞pi)、L2(P′-＞pj)和L3(pi-＞pi)。\n[0036] (5)三条边中若有长度为0的边，则重合点作为最近位置点Pv，然后进入步骤(9)；\n否则，进入步骤(6)。即，若L1=0，则最近点Pv=pi；若L2=0，则最近点Pv=pj；若L3=0，则最近点为pi或pj均可。\n[0037] (6)若P′、A、B三点在一条直线上，根据三点间的位置关系，计算最近位置点Pv，然后进入步骤(9)；否则，进入步骤(7)。若P′在线段AB的左延长线上，则Pv=pi；在线段AB的右廷长线上，则Pv=pj；若P′在线段AB上，Pv=P′。\n[0038] (7)根据三角形余弦定理，计算角∠A和角∠B大小。已知三条边长分别为L1、\n2 2 2 2 2 2\nL2和L3，则角∠A=acos((L1+L3-L2)／(2*L1*L3))，角∠B= acos((L2+L3-L1)／(2*L2*L3))。\n[0039] (8)若角∠A、角∠B中有一为直角或钝角，则相应点作为最近位置点Pv；若角∠A、角∠B均为锐角，则利用三角函数计算P′点在线段AB上的垂足M，作为最近位置点Pv。\n[0040] 如根据角∠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。\n[0041] (9)将航路最近位置点的空间直角坐标Pv转换为大地坐标Pv′。根据空间直角坐标(XYZ)与大地坐标(LBH)的转换公式，将最近位置点的空间直角坐标，Pv(X，Ｙ，Ｚ），转换为大地坐标Pv′(Ｌ，Ｂ，Ｈ）。\n[0042] (10)在大地坐标系下，计算当前位置点P和航路最近位置点Pv′间的大地水平距离和高差。\n[0043] (11)判定水平距离和高差是否在允许的偏差范围内，若均在容许范围内，则认为没有偏航；否则，重复步骤(3)至步骤(１１)，直至航路所有位置点遍历完毕，若当前位置点不在任一段航路容许范围内，则判定为偏离了航线。\n[0044] 其中，步骤(1)中的大地坐标(L、B、Ｈ，分别为大地经度、大地纬度、大地高)换算为空间直角坐标(Ｘ、Ｙ、Ｚ，分别为空间三维直角坐标分量)的公式为：Ｘ＝（Ｎ＋Ｈ）cosB \n2\ncosL，Ｙ＝(Ｎ＋Ｈ）cosB sinL，Ｚ＝[N(１－e)+Ｈ］sinB；步骤(9)中的空间直角坐标换\n２ ２ 2 -1\n算为大地坐标的公式为：L=arctan(Ｙ／Ｘ），B=arctan[Ｚ／(Ｘ +Ｙ ）*(１-eN(N+H) ]，\n2 2 0.5 2 2 2 2\nH=(X+Y) ／cosB-N。其中，e为椭球的第一偏心率，e=(a-b)／a，N为卯酉圈曲率半\n2 2 0.5\n径，N=a／(1-esinB) ，a为椭球长半轴长，b为椭球短半轴长。