航空器航迹定位数据偏移的修正方法及装置
文献发布时间:2023-06-19 09:52:39
技术领域
本发明涉及航空器定位技术领域,尤其涉及一种航空器航迹定位数据偏移的修正方法及装置。
背景技术
在机场路由引导的项目应用中,需要结合软件系统对跑道边灯的控制,对航空器进行路由灯光引导。在引导的过程中,需要航空器按照软件计算出来的优化路径去行驶,点亮相关路径周围的道面灯光,航空器按照灯光指示行进。航空器的实时位置数据,由分布式定位系统计算并发送给应用软件端,以此来绘制航空器的航迹信息。软件通过飞机已走过的航迹信息,实时控制熄灭已走过的历史航迹所在路径沿途的灯光,保留未行使路径沿途的灯光。当航空器临时因为某种原因,从岔口离开预设的优化路径时,原来的未行进完毕的优化路径所在的道面沿途灯光全部熄灭,并根据航空器实时位置重新计算优化路径,并点亮新路径所在道面沿途的灯光。
由于定位精度原因,定位数据会存在较大误差,所以在路有引导过程中,因为误差导致定位数据漂移,最主要会引起以下两个方面的问题:
在航空器静止处于滑行道起点时,软件端在接收到定位数据,会错误地发现航空器在向前运动,就会错误地控制前进方向后面的灯光熄灭;
在航空器引导行进到某个岔口临时改变方向偏离预设的优化路径时,软件端在接收到定位数据,会错误地以为航空器还在按预设的优化路径进行,继续保留未进行完毕的路径的灯光,直到航空器走出一定距离后才迟缓地发现已经偏离,并重新给出路由规划建议,熄灭先前路径的灯光,点亮重新规划路径的灯光。
总体来说,就是因为定位数据漂移的原因,会导致灯光控制和航空器运行状态之间没有同步一致,且路径实时重新规划的响应速度较航空器运行计划改变之间有很大延迟。
现有的解决定位数据漂移,进行航迹偏移修正的方法,主要是通过以下三个方面:
提高定位算法的定位精度。缺点:硬件方面,需要更换或添置数量更多、精度更高、性能更强的通讯设备、计算设备、存储设备,成本高昂;软件方面,定位算法的改进难度大,改进空间小,提升效果不明显。
通过道面固有的路径信息去做路径匹配。缺点:需要对道面进行详细的数据建模,传输或存储的数据,其类型和结构会变得复杂,数据吞吐量和计算开销会陡增;对于航空器因为意外原因进行到建模路网以外的区域时,无法进行正确的匹配和定位。
对测量出来带有误差的定位数据在软件算法层面上进行修正。这是目前兼顾开发成本、开发难度、资源消耗、使用和维护便捷等因素,所采用的主流解决方式。但是现有的修正方法,都是去分析统计历史轨迹的运动规律,包括但不限于位置、速度、加速度、分布规律等,通过预测或拟合的方法找到当前航空器的正确位置。这样设计存在以下缺点:
(1)一些修正方法修正后的路径连续光滑,能很好地反映行进趋势,但偏离实际测量数据较远,不能反映真实位置信息。
(2)一些修正方法修正后保持了较高的精度,能很好地反映真实位置信息,但路径连续性不好(如呈锯齿状),不能与进行的道面吻合;
以上方法都不能很好地过滤掉“由于定位数据漂移导致的轨迹自相交,并形成软状分布,在团状分布中轨迹出现往复运动”的情况,这不符合大型航空器的物理运动规律。
发明内容
有鉴于此,本发明提供一种航空器航迹定位数据偏移的修正方法以及装置,以实现定位准确且稳定性高,轨迹更符合运动规律。
一方面,本发明提供一种航空器航迹定位数据偏移的修正方法,包括:
在进行航空器当前航迹定位数据偏移的修正操作之前清空历史缓存信息;
接收分布式定位系统发送的航空器的实时测量点信息;
根据所述实时测量点信息以及当前缓存信息,确定用于作为过滤罩的当前抛物线以及实时偏转角信息;所述当前缓存信息包括:上一测量点缓存信息、上一过滤点缓存信息、上一偏转角缓存信息、以及包括当前航迹的初始过滤点至上一过滤点之间各过滤点信息的缓存队列;所述上一偏转角缓存信息为x轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到所述当前抛物线的顶点连线形成向量之间的夹角;
根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息;
根据所述实时测量点信息、实时过滤点信息、实时偏转角信息更新当前缓存信息;
根据所述当前航迹的所有过滤点信息,得到航空器当前航迹的修正航迹。
进一步地,根据所述实时测量点信息以及当前缓存信息,确定实时偏转角信息包括:
确定上一过滤点缓存信息到实时测量点信息连接而成的线段与当前抛物线边界的公共点;
轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到当前抛物线边界的公共点连线形成向量之间的夹角作为实时偏转角缓存信息。
进一步地,根据所述实时测量点信息以及当前缓存信息,确定用于作为过滤罩的当前抛物线包括:
将所述上一过滤点缓存信息为用于作为过滤罩的当前抛物线的焦点,并将所述上一测量点缓存信息与上一过滤点缓存信息的连线为当前抛物线的中线上的线段,以及根据所述上一测量点缓存信息与实时测量点信息之间的连线长度确定所述当前抛物线的大小。
进一步地,根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息的步骤包括:
计算上一偏转角信息和实时偏转角信息之间的夹角,再计算所述当前抛物线边界的公共点与所述当前抛物线的焦点之间的距离,如果公共点存在,则在所述当前抛物线的焦点与所述实时测量点信息形成的线段上确定实时过滤点信息,所述实时过滤点信息满足上一过滤点信息与所述公共点的距离等于所述实时过滤点信息与所述实时测量点之间的距离,若公共点不存在,实时过滤点信息即为上一过滤点信息。
进一步地,根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息的步骤之后还包括:
根据所述缓存队列修正实时过滤点信息,以根据所述修正后的实时过滤点信息更新当前缓存信息以及得到航空器当前航迹的修正航迹。
本发明还提供一种航空器航迹定位数据偏移的修正装置,包括:
预处理单元,用于在进行航空器当前航迹定位数据偏移的修正操作之前清空历史缓存信息;
接收单元,用于接收分布式定位系统发送的航空器的实时测量点信息;
过滤单元,用于根据所述实时测量点信息以及当前缓存信息,确定用于作为过滤罩的当前抛物线以及实时偏转角信息;以及根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息;所述当前缓存信息包括:上一测量点缓存信息、上一过滤点缓存信息、上一偏转角缓存信息、以及包括当前航迹的初始过滤点至上一过滤点之间各过滤点信息的缓存队列;所述上一偏转角缓存信息为轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到所述当前抛物线的顶点连线形成向量之间的夹角;
更新单元,用于根据所述实时测量点信息、实时过滤点信息、实时偏转角信息更新当前缓存信息;
航迹修正单元,用于根据所述当前航迹的所有过滤点信息,得到航空器当前航迹的修正航迹。
进一步地,所述过滤单元具体用于:确定上一过滤点缓存信息到实时测量点信息连接而成的线段与当前抛物线边界的公共点;轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到当前抛物线边界的公共点连线形成向量之间的夹角作为实时偏转角缓存信息。
进一步地,所述过滤单元具体还用于:将所述上一过滤点缓存信息为用于作为过滤罩的当前抛物线的焦点,并将所述上一测量点缓存信息与上一过滤点缓存信息的连线为当前抛物线的中线上的线段,以及根据所述上一测量点缓存信息与实时测量点信息之间的连线长度确定所述当前抛物线的大小。
进一步地,所述过滤单元具体还用于:计算上一偏转角信息和实时偏转角信息之间的夹角,再计算所述当前抛物线边界的公共点与所述当前抛物线的焦点之间的距离,如果公共点存在,则在所述当前抛物线的焦点与所述实时测量点信息形成的线段上确定实时过滤点信息,所述实时过滤点信息满足上一过滤点信息与所述公共点的距离等于所述实时过滤点信息与所述实时测量点之间的距离,若公共点不存在,实时过滤点信息即为上一过滤点信息。
进一步地,所述的航空器航迹定位数据偏移的修正装置还包括:
过滤点信息修正单元用于:根据所述缓存队列修正实时过滤点信息,以使得所述更新单元根据所述修正后的实时过滤点信息更新当前缓存信息以及使得所述航迹修正单元根据所述修正后的实时过滤点信息得到航空器当前航迹的修正航机。
本发明航空器航迹定位数据偏移的修正方法及装置,位置都是被修正到附近小范围空间领域中,保证不过度偏离测量数据,形成连续光滑的行进轨迹,定位准确且稳定性高,轨迹更符合运动规律。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1为根据本发明示例性第一实施例的航空器航迹定位数据偏移的修正方法的流程图。
图2为根据本发明示例性第二实施例的航空器航迹定位数据偏移的修正方法的框架概略图。
图3为根据本发明示例性第三实施例的航空器航迹定位数据偏移的修正方法的数据流框架图。
图4为根据本发明示例性第四实施例的航空器航迹定位数据偏移的修正方法的计算流程框架图。
图5为Shell结构中相关点之间的空间关系。
图6为一个简单过滤轨迹的生成过程示例。
图7为历史过滤点对最新过滤点的修正示意图。
图8为历史过滤点对最新过滤点的修正程序截图。
图9为长距离往返轨迹在路径上的收敛效果程序截图。
图10为静止状态下漂移的过滤效果程序截图。
图11为直行状态下漂移的过滤效果程序截图。
图12为静止起步状态下漂移的过滤效果程序截图。
图13为减速停止状态下漂移的过滤效果程序截图。
图14为转向状态下漂移的过滤效果程序截图。
图15为根据本发明示例性第五实施例的航空器航迹定位数据偏移的修正装置的结构图。
具体实施方式
下面结合附图对本发明实施例进行详细描述。
需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合;并且,基于本公开中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。
需要说明的是,下文描述在所附权利要求书的范围内的实施例的各种方面。应显而易见,本文中所描述的方面可体现于广泛多种形式中,且本文中所描述的任何特定结构及/或功能仅为说明性的。基于本公开,所属领域的技术人员应了解,本文中所描述的一个方面可与任何其它方面独立地实施,且可以各种方式组合这些方面中的两者或两者以上。举例来说,可使用本文中所阐述的任何数目个方面来实施设备及/或实践方法。另外,可使用除了本文中所阐述的方面中的一或多者之外的其它结构及/或功能性实施此设备及/或实践此方法。
本发明航空器航迹定位数据偏移的修正方法的思路为:利用空间上的滞后性设计,去抵消因为前方即将出现的测量点的不可预测性。通俗地比喻,就是:现在有A和B两个人,在同一起点同时出发,沿着一条确定的小路从起点走到终点。A走的路径代表定位算法给出测量点绘制的轨迹,会“忽左、忽右、忽前、忽后”地对于确定的小路从起点到终点,A每走一步就会停下来,等着B跟进一步,相互交替,直到终点。B要走的就是修正算法给出的点绘制的轨迹,B会根据A的位置,向前迈出一步,保证自己走的路尽可能是沿着确定的小路,一直连续向前稳稳地走到终点,不会出现“忽左、忽右、忽前、忽后”的情况。现在B的做法是:
①A先走,B始终与A保持一步之差,刚开始时他们都位于同一出发点;
②B根据A的速度,始终与A保持恰当的距离,A速度越快B离A越远,反之B离A越近;
③如果A在B的正前方突然停下来了,或朝着B的方向出现倒退,B站在原地不动,直到A继续向正前方走,超出一定距离,B再跟上去;
④如果A突然改变方向,不再处于B的正前方,那么B会首先调整前进方向为正对A的方向,
再根据此时A和B的距离,决定需要跟进上去的距离或保持原地不动。
以下航空器航迹定位数据偏移的修正方法各实施例,就是将上述游戏思路,形式化将其形式化为数学方法,并算法化后加以实现。
如图1所示,一种航空器航迹定位数据偏移的修正方法包括:
步骤101,在进行航空器当前航迹定位数据偏移的修正操作之前清空历史缓存信息;
步骤102,接收分布式定位系统发送的航空器的实时测量点信息;
步骤103,根据所述实时测量点信息以及当前缓存信息,确定用于作为过滤罩的当前抛物线以及实时偏转角信息;所述当前缓存信息包括:上一测量点缓存信息、上一过滤点缓存信息、上一偏转角缓存信息、以及包括当前航迹的初始过滤点至上一过滤点之间各过滤点信息的缓存队列;所述上一偏转角缓存信息为x轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到所述当前抛物线的顶点连线形成向量之间的夹角;
步骤104,根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息;
步骤105,根据所述实时测量点信息、实时过滤点信息、实时偏转角信息更新当前缓存信息;
步骤106,根据所述当前航迹的所有过滤点信息,得到航空器当前航迹的修正航迹。
本实施例位置都是被修正到附近小范围空间领域中,保证不过度偏离测量数据,形成连续光滑的行进轨迹,定位准确且稳定性高,轨迹更符合运动规律。
具体地,如图2所示,航空器航迹定位数据偏移的修正方法概略框架图包括以下步骤:
①过滤算法模块包含初始化和计算两个功能,模块内部自带缓存机制;
②在使用过滤算法模块生成过滤轨迹之前,需要调用初始化功能清空缓存;
③过滤算法模块整体接收一个最新测量点作为输入;
④通过输入数据和缓存数据来调用计算功能,生成最新过滤点,并更新缓存数据;
⑤过滤算法模块整体返回一个最新测量点作为输出;
⑥返回步骤③,过滤算法模块接收下一个最新测量点,或者结束。
进一步地,如图3所示,航空器航迹定位数据偏移的修正方法数据流框架图(对应细化概略框架图)包括以下步骤:
①过滤算法模块包含两个函数:初始化函数和几何计算函数,包含四个缓存变量:最近测量点缓存、最近过滤点缓存、最近偏转角缓存、最近历史过滤点的缓存队列;
②在使用过滤算法模块生成过滤轨迹之前,需要且仅需要调用一次初始化函数来清空缓存,以清除生成上一条完整过滤轨迹的计算过程中留在缓存变量中的临时数据;
③过滤算法模块整体等待接收一个最新测量点作为输入,最新测量点的数据是来至分布式定位系统的即时计算结果,并将该点添加到当前原始轨迹中;
④通过将最新测量点和所有缓存数据输入到几何计算函数,计算生成最新过滤点,分别使用最新测量点和最新过滤点来更新最近测量点缓存和最近过滤点缓存,使用最新偏转角来更新最近偏转角缓存,将最新过滤点添加到最近生成的历史过滤点的环形缓存队列中(若队列已满,覆盖最早的过滤点存储的位置);
⑤过滤算法模块整体返回一个最新过滤点作为输出,并添加到当前过滤轨迹中;
⑥返回步骤③,过滤算法模块等待接收下一个最新测量点,或者结束。
为更详细的解释航空器航迹定位数据偏移的修正方法的实现思路,现描述基础变量和基本函数定义:
①P是一个轨迹点,用于指定运动目标在某个时刻在地球表面上的位置,P(x,y)是P数据格式表示形式,是由经纬度坐标转换成的局部大地参考系的二维直角坐标,x、y分别是直角坐标系下的横坐标和纵坐标。
②L是一条轨迹,表示为L={P
③若P点与抛物线焦点连接而成的线段,与抛物线无公共点,则P位于抛物线内部;抛物线及其内部区域这里称为Shell(过滤罩);抛物线焦点是某个过滤点S,称为Shell的焦点;抛物线的顶点Z称为Shell的顶点;抛物线的对称中线称为Shell的中线;抛物线本身称为Shell的边界;Shell边界上的一点称为C;x轴正方向的单位向量
④Shell(s,f,α)是过滤罩Shell数据格式表示形式;其中s表示Shell的焦点,f表示Shell中线段SZ的距离,α表示Shell的偏转角;Shell的位置、大小、方向分别是由s、f、α唯一确定的;f允许的最小值设为Min_f,允许的最大值设为Max_f。
⑤对于轨迹LS={S
⑥Shell
⑦fliter是过滤算法模块的实例;Init是初始化函数,在使用模块生成完整过滤轨迹之前仅调用一次,调用方式为:fliter.Init();Generate是计算函数,每接收到一个测量点就要调用一次来生成一个过滤点,调用方式为:S
⑧F
⑨AddElement是RN中添加元素的方法,调用方式RN.AddElement(S
S
⑩GeoF是fliter中实现Generate的核心函数,称为几何计算函数,满足关系S
具体地,如图4所示,航空器航迹定位数据偏移的修正方法的计算流程框架图(主要将数据流框架图中的计算部分流程化、形式化)包括以下步骤:
S1:fliter是过滤算法模块的实例,调用初始化函数fliter.Init()以清空缓存变量F
设置全局接收点顺序索引号i=-1。
S2:接收一个最新测量点F
S3:该步骤为几何计算函数计算生成最新过滤点,并更新缓存数据的过程:
S
步骤S3中对函数GeoF的实现是具体实施的最主要内容,重点讨论子步骤S33(生成Shell
S31:判断历史过滤点的环形缓存队列RN是否为空队列:bool=RN.IsEmpty();如果bool为真,转至步骤S32,否则转至步骤S33。
S32:此时LS中还没有过滤点生成,这里需要生成第一个过滤点,设置第一个过滤点就是第一个测量点:S
函数GeoF实现过程如下:
①计算bool=RN.IsEmpty(),判断bool是否为真,如果不是,转至步骤③;
②最新过滤点直接取值为最新测量点:S
③计算Shell
④计算α
⑤计算S
⑥计算S
⑦判断S
⑧计算α
⑨更新缓存变量的值:F
⑩将最新过滤点S
S33:调用Shell
其中步骤S33中的Create函数的实现过程如下:
①创建Shell
②计算最新测量点F
③计算与步骤①中生成的Shell
④返回计算最新过滤点S
其中工具函数Linear的实现如下,
①判断x≤X
②判断x≥X
③返回一个介于(0,1)之间的比例系数:(x-X
注:Shell
S34:调用S
其中工具函数CosP的实现如下,它是一种关于参数(ρ
|S
注:当α
GetRaw函数的过程说明如图6的示例所示,Shell
之所以会构造Shell这种几何形状作为过滤罩,是因为它相对于航空器的运动方向呈现对称性,并且便于计算。Shell
S35:调用S
在不考虑Attach函数修正影响的前提下,即函数GeoF省去步骤S35,我们来完整地演示一遍函数GeoF是如何工作的。如图6所示,是一个简单过滤轨迹的生成过程示例图:
①获得初始测量点F
②获得F
③获得F
④获得F
⑤获得F
⑥获得F
⑦获得末尾点F
所以将折线LF=F
其中步骤S33和步骤S35中的Update函数的实现过程如下:
①给定一个轨迹点p,它可以是最新测量点F
②判断S
③通过轨迹点p和缓存在S
④返回最新偏转角α
注:最新测量点F
其中步骤S34中的GetRaw函数的实现过程如下:
①从过滤罩Shell
②判断α
③计算最近偏转角α
④从过滤罩Shell
⑤计算最近过滤点S
⑥计算最近过滤点S
⑦判断|S
⑧计算距离比值系数λ=|S
⑨返回最新过滤点S
其中步骤S35中的Attach函数的实现过程如下:
①判断RN.Size()>0是否成立,若不成立,转至步骤⑨;
②获取环形缓存队列RN中的最近轨迹点S
③计算RN中每一点到S
④判断min_d<Min_f和min_d<|S
⑤最新过滤点S
⑥计算RN中每相邻两点构成的线段到S
⑦判断min_l<Min_f和min_l<|S
⑧根据步骤⑥中得到的比例系数,min_λ计算最新过滤点位于线段min_pA min_pB上的最新过滤点:S
⑨返回最新过滤点S
注:在三种情况下,代入函数的参数S
Attach函数的过程说明如图7的示例所示,分别展示了两种不同的修正S
之所以设计子函数Attach,是因为函数GeoF中经过子函数GetRaw初步生成的最新过滤点S
Attach函数发挥效果的实际程序运行截图如图8所示,该图显示的场景涉及了图5和图7这两张示意图说明的集合对象。Situation A和Situation B中,修正轨迹点的情形分别对应图7的Situation:A和Situation:B。图中标记数字的小圆点代表轨迹点及其位置,用竖直连线连接的上方带*的数字表示生成一条完整过滤轨迹后(预先从数据库调取的航迹记录),在该圆点对应位置重合的轨迹点数目。相邻的轨迹点之间用线段连接构成完整的LS(因为每个圆点可能是重合的多个轨迹点,所以构成折线LS的某一条线段可能是多次重合线段的结果)。Shell
其中步骤S35中的Update函数,调用条件是经过Attach函数计算后的S
S36:此时最新过滤点S
S4:输出一个最新过滤点S
本实施例首先数据复杂性要求低,仅需要基于时间先后的测量点的空间位置信息,不需要每个测量点的时间戳去计算基于时间差的运动规律,也不需要依赖于道路信息去做提高精度的路径匹配;其次,计算资源消耗小,运用简单的空间几何关系计算得出结果,输入最新测量点后迅速计算出最新过滤点,不需要对历史数据做拟合等统计分析来预测运动趋势,大大减少计算开销;再次,定位准确且稳定性高,轨迹更符合运动规律,位置都是被修正到附近小范围空间领域中,保证不过度偏离测量数据,形成连续光滑的行进轨迹、不出现自相交、前后往复、左右锯齿状摆动等情况,能体现稳定静止、匀加减速、平滑转弯等符合物理惯性特征的运动趋势。
本实施例在定位数据的定位精度误差在5m~10m的情况下,Min_f=5、Max_f=100、Min_d=30、Max_d=150、N=1000的参数设置下,可以达到以下效果:
如图10所示,运动目标在事实静止的情况下,接受到的红色标注的测量点给出的定位数据出现团状分布,分布范围在约8m跨度的平面空间中,并在点与点之间出现约1m~3m幅度的随机性漂移,形成自相交轨迹(上半图);过滤算法将团状分布的点集,修正映射到单个蓝色标注的过滤点上,该点所在的位置是团状分布空间内的某一点,随着测量点在空间内漂移,过滤点保持进行不动,符合静止的实际情况(下半图)。
如图11所示,运动目标在事实直行的情况下,接受到的红色标注的测量点给出的定位数据出现沿直行的左右方向漂移,并前后往复运动,形成锯齿状并存在局部自相交的尺寸约4m的小团块的曲折轨迹(上半图);过滤算法将测量点绘制的轨迹,修正到一条蓝色标注的过滤点构成的不再往复,连续向前行进的光滑轨迹上(下半图)。
如图12所示,运动目标在从事实静止到加速的过程中,接受到的红色标注的测量点给出的定位数据在起步到逐渐加速的时候出现团状分布,形成轨迹头部为自相交的尺寸约6m的小团块而后曲折行进的轨迹(上半图);过滤算法将测量点绘制的轨迹,修正到一条蓝色标注的过滤点构成的逐渐加速、连续向前行进的光滑轨迹上(下半图)。
如图13所示,运动目标在从事实减速到静止的过程中,接受到的红色标注的测量点给出的定位数据在逐渐减速到静止的时候出现团状分布,形成轨迹曲折行进而后尾部为自相交的尺寸约5m的小团块的轨迹(上半图);过滤算法将测量点绘制的轨迹,修正到一条蓝色标注的过滤点构成的逐渐减速、连续向前行进的光滑轨迹上(下半图)。
如图14所示,运动目标在事实变速转弯的情况下,接受到的红色标注的测量点给出的定位数据在“减速后转向”与“转向后加速”的转向过程中出现团块分布,分布范围在约12m跨度的平面空间中,团块内部点与点之间出现1m~2m幅度的随机性漂移,形成锯齿状行进、转弯时自相交轨迹(上半图);过滤算法将测量点绘制的轨迹,修正到一条蓝色标注的过滤点构成的“逐渐减速、果断转弯、逐渐加速”并且过程中不出现往复运动的连续向前行进的光滑轨迹上(下半图)。
如图15所示,本发明示例性第五实施例的航空器航迹定位数据偏移的修正装置的结构图包括:
预处理单元1501,用于在进行航空器当前航迹定位数据偏移的修正操作之前清空历史缓存信息;
接收单元1502,用于接收分布式定位系统发送的航空器的实时测量点信息;
过滤单元1503,用于根据所述实时测量点信息以及当前缓存信息,确定用于作为过滤罩的当前抛物线以及实时偏转角信息;以及根据所述实时测量点信息、当前抛物线以及实时偏转角信息,计算生成所述实时测量点对应的实时过滤点信息;所述当前缓存信息包括:上一测量点缓存信息、上一过滤点缓存信息、上一偏转角缓存信息、以及包括当前航迹的初始过滤点至上一过滤点之间各过滤点信息的缓存队列;所述上一偏转角缓存信息为轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到所述当前抛物线的顶点连线形成向量之间的夹角;
更新单元1504,用于根据所述实时测量点信息、实时过滤点信息、实时偏转角信息更新当前缓存信息;
航迹修正单元1505,用于根据所述当前航迹的所有过滤点信息,得到航空器当前航迹的修正航迹。
优选地:所述过滤单元1503具体用于:确定上一过滤点缓存信息到实时测量点信息连接而成的线段与当前抛物线边界的公共点;轴正方向的单位向量沿着逆时针方向与从所述当前抛物线的焦点到当前抛物线边界的公共点连线形成向量之间的夹角作为实时偏转角缓存信息。
优选地:所述过滤单元1503具体还用于:将所述上一过滤点缓存信息为用于作为过滤罩的当前抛物线的焦点,并将所述上一测量点缓存信息与上一过滤点缓存信息的连线为当前抛物线的中线上的线段,以及根据所述上一测量点缓存信息与实时测量点信息之间的连线长度确定所述当前抛物线的大小。
优选地:所述过滤单元1503具体还用于:计算上一偏转角信息和实时偏转角信息之间的夹角,再计算所述当前抛物线边界的公共点与所述当前抛物线的焦点之间的距离,如果公共点存在,则在所述当前抛物线的焦点与所述实时测量点信息形成的线段上确定实时过滤点信息,所述实时过滤点信息满足上一过滤点信息与所述公共点的距离等于所述实时过滤点信息与所述实时测量点之间的距离,若公共点不存在,实时过滤点信息即为上一过滤点信息。
优选地:所述的航空器航迹定位数据偏移的修正装置还包括:过滤点信息修正单元1506用于:根据所述缓存队列修正实时过滤点信息,以使得所述更新单元根据所述修正后的实时过滤点信息更新当前缓存信息以及使得所述航迹修正单元根据所述修正后的实时过滤点信息得到航空器当前航迹的修正航迹
本实施例修正后的路径连续光滑,不会出现运行方向和位移程度突变的情况,能很好地反映航空器的连续行进趋势;修正后的路径中的每一个点,与对应的实际测量数据之间,不存在太大的偏差,把误差控制在较小范围,并尽可能与进行的道面在空间上吻合;修正后的路径,要过滤掉因定位数据误差漂移造成的轨迹自相交的情况,消除轨迹在较小空间范围内出现的团结分布、高度折叠等情况,阻止出现沿着道面行进方向上的往复运动,使轨迹的形态符合航空器运动的物理规律,如呈现持续前进、缓慢加减速、转弯幅度大、不能轻易改变方向等大惯性物体的运动特征。本修正装置对输入数据的依赖必须足够简单,仅仅需要输入按时间先后顺序生成的、来至定位数据的测量点序列,通过对这些点的空间几何关系的分析,计算得出合理的修正后的定位点,而不需要依赖额外的数据集,避免增加使用、维护、计算难度。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
- 航空器航迹定位数据偏移的修正方法及装置
- 航空器航迹定位数据偏移的修正方法及装置