CN104180800A - 基于ads-b***航迹点的修正方法和*** - Google Patents
基于ads-b***航迹点的修正方法和*** Download PDFInfo
- Publication number
- CN104180800A CN104180800A CN201410412785.3A CN201410412785A CN104180800A CN 104180800 A CN104180800 A CN 104180800A CN 201410412785 A CN201410412785 A CN 201410412785A CN 104180800 A CN104180800 A CN 104180800A
- Authority
- CN
- China
- Prior art keywords
- track points
- current time
- value
- matrix
- covariance matrix
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
一种基于ADS-B***航迹点的修正方法和***,其方法包括步骤:对航迹点按接收时间进行排列;根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。根据本发明方案,能够有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
Description
技术领域
本发明涉及基于ADS-B的民用航空空中监管领域,特别是涉及一种基于ADS-B***航迹点的修正方法和***。
背景技术
ADS-B(Automatic Dependent Surveillance Broadcast,广播式自动相关监视)监控设备在民用航空空中监管的使用过程中,由于噪声干扰、窜扰、混扰、多径干扰等因素的影响,得到的航迹点数据往往包含了较大的随机误差,造成航迹点数据严重偏离目标真实值,即成为野值。
目前,传统的航迹点野值处理方法是通过模糊控制函数判断新的航迹值是否为野值,如果不是野值,则不对航迹估计值进行调整;如果野值较小,则调整增益实现对野值的修正;如果野值较大,则对野值进行剔除。然而,这种野值的处理方法,存在野值判断不灵敏,无法实现对野值实时动态的修正;对于连续成片的野值,还有可能存在野值的判定和处理误差较大的情况,且对于较大的野值,直接将该野值剔除,无法实现航迹点野值的修正,而且降低了航迹点数据的准确度。
发明内容
基于此,有必要针对背景技术中,现有的航迹点野值处理方法出现野值判断不灵敏,无法实现对野值实时动态的修正,降低了航迹点数据的完整性的问题,提供一种基于ADS-B***航迹点的修正方法,能够有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
为实现上述目的,本发明实施例采用的技术方案如下:
一种基于ADS-B***航迹点的修正方法,包括步骤:
对航迹点按接收时间进行排列;
根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;
根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;
识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;
根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;
根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。
根据上述的一种基于ADS-B***航迹点的修正方法,本发明提供一种基于ADS-B***航迹点的修正***,包括预处理单元、计算修正单元;
所述预处理单元对航迹点按接收时间进行排列;
所述计算修正单元根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。
根据本发明方案,先对航迹点按接收时间进行排列;然后根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;并预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;进而识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;再进一步根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;最后修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。进而达到有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
附图说明
图1为本发明基于ADS-B***航迹点的修正方法的实施例流程图;
图2为本发明基于ADS-B***航迹点的修正方法的一维仿真模型图;
图3为本发明基于ADS-B***航迹点的修正方法的一维仿真修正结果图;
图4为本发明基于ADS-B***航迹点的修正***结构图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步的详细说明。应当理解,此处所描述的具体实施方式仅仅用以解释本发明,并不限定本发明的保护范围。
请参阅图1,为本发明基于ADS-B***航迹点的修正方法的实施例流程图:
步骤S101:对航迹点按接收时间进行排列;
具体地,所述按接收时间排列航迹点是指将接收到的航迹点由大地坐标系转化为直角坐标系,再将航迹点的数据按照接收的时间是先后顺序进行排列。
步骤S102:根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;
所述当前时刻航迹点的状态预测值是指当前时刻飞行目标的状态信息,包括飞行目标的位置、速度、加速度等;所述当前时刻航迹点的状态预测协方差矩阵主要是体现当前时刻航迹点的状态预测值的误差,通过调整当前时刻航迹点的状态预测协方差矩阵能够减少当前时刻航迹点的状态预测值的误差。
具体地,在一个实施例中,所述根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前航迹点的状态预测协方差矩阵通过下述方程式计算得到:
P(k/k-1)=Φ(k-1)P(k-1/k-1)ΦT(k-1)+Q(k-1)
其中,为当前时刻航迹点的状态预测值,P(k/k-1)为当前时刻航迹点的状态预测协方差矩阵,为前一时刻航迹点的状态预测值,P(k-1/k-1)为前一时刻航迹点的状态预测协方差矩阵;
所述航迹点状态信息包括前一时刻状态转移矩阵Φ(k-1)、前一时刻控制矩阵U(k-1)、前一时刻机动加速度均值前一时刻航迹点的状态预测协方差矩阵P(k/k-1)、前一时刻状态转移矩阵的转置矩阵ΦT(k-1)、前一时刻噪声方差矩阵Q(k-1)。
进一步地:
前一时刻状态转移矩阵
α为机动频率,转弯机动频率α=1/60,逃避机动频率α=1/20,大气扰动机动频率α=1;T为采样时间;e为欧拉数;
前一时刻控制矩阵
当前时刻噪声方差矩阵
式中
为k-2时刻的加速度预测值。
步骤S103:根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;
所述当前时刻航迹点的测量预测值指的是当前时刻航迹点的位置信息,所述当前时刻航迹点的残差向量协方差矩阵主要是体现当前时刻航迹点的测量预测值的误差,通过调整当前时刻航迹点的残差向量协方差矩阵能够减少当前时刻航迹点的测量预测值的误差。
具体地,在一个实施例中,所述根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵通过下述方程式计算得到:
S(k)=H(k)P(k/k-1)HT(k)+R(k)
其中,为当前时刻航迹点的测量预测值,S(k)为当前时刻航迹点的残差向量协方差矩阵;
所述航迹点状态信息还包括当前时刻测量矩阵H(k)、当前时刻测量矩阵的转置矩阵HT(k)、当前时刻观测噪声R(k)。
较优地,在一个实施例中,当前时刻观测噪声R(k)的值可以为30,当前时刻测量矩阵H(k)=[100]。
步骤S104:识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;
所述野值是指该航迹点数据严重偏离目标真实值,即为野值;由于要对野值进行修正,所以先判定该航迹点是否为野值,再确定该航迹点的衰减因子。
具体地,在一个实施例中,所述识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子通过下述方程式计算得到:
其中,为当前时刻航迹点的新息,当时,当前时刻航迹点不是野值,当时,当前时刻航迹点为野值;Y(k)为当前时刻航迹点的测量值,为当前时刻航迹点的测量预测值,d设置为3,r(k)为当前时刻航迹点的衰减因子。
应当指出的是,d的值也可以设置成其他大于零的自然数;在本发明方案中,d设置为3是一个识别当前时刻航迹点是否为野值较优的实施例。
步骤S105:根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;
所述当前时刻滤波器增益是指用于修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵的增益值;
具体地,所述根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益通过下述方程式计算得到:
K(k)=r(k)P(k)HT(k)S-1(k)
其中,K(k)为当前时刻滤波器增益,)S-1(k)为当前时刻航迹点的残差向量协方差矩阵的逆矩阵。
通过调整滤波器衰减因子的大小(即r(k)),改变滤波器增益,实现了野值自适应修正。由上述方程式可以得到,野值的修正是通过衰减因子r(k)对增益进行调整实现的,调整范围为[0,1]。即是野值与预测偏离得越大,限制作用也越大,当非常大时,增益几乎接近于零,当处于正常值时,增益的值为1。
步骤106:根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵;
具体地,所述根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵通过下述方程式计算得到:
P(k/k)=P(k/k-1)-K(k)S(k)KT(k)
其中,为修正后的当前时刻航迹点的状态预测值,P(k/k)为修正后的当前航迹点的状态预测协方差矩阵,KT(k)为当前时刻滤波器增益转置矩阵。
可以看到,本发明的基于ADS-B***航迹点的修正方法,能够有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
较优地,在一个实施例中,在对航迹点按接收时间进行排列之后,预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵之前还可以包括步骤:
将每两个航迹点的时间间隔与滤波器的采样时间间隔进行比较;
若时间间隔不一致,则判断该两个航迹点之间存在航迹点丢失;
用野值对丢失的航迹点进行填充。
具体地,对丢失的航迹点可以数值为0的野值进行填充,通过找出丢失的航迹点,用野值进行填充,能够保证航迹点数据的完整,在野值被修正后可以获得更准确的航迹点数据。
为了进一步说明本发明的基于ADS-B***航迹点的修正方法,下面建立一个一维仿真模型:
首先,在MATLAB2008(matrix laboratory,矩阵实验室)建立飞机运动方程,然后计算出一维坐标下的航迹点,并对该些航迹点进行随机噪声和随机缺失处理,形成模拟的一维飞机航迹;具体地,请参阅图2,为本发明基于ADS-B***航迹点的修正方法的一维仿真模型图,模拟飞机的航迹如下:
设飞机的初始位置为10000,[1,20]秒做速度为600m/s匀速运动,[20,40]秒做加速度为-2g的减速运动,[40,80]秒做加速度为g(自然加速度)的加速运动,[80,100]秒做匀速运动。在[10,30]中20%的航迹点加入200倍随机噪声,同时在[30,100]航迹点随机引发20%航迹缺失,航迹缺失的点用极大野值填充(例子中用0填充)。
接着,在MATLAB2008中利用本发明的基于ADS-B***航迹点的修正方法对上述模拟飞机的航迹进行修正,得到仿真结果;请参阅图3,为本发明基于ADS-B***航迹点的修正方法的一维仿真修正结果图;仿真结果显示了本发明基于ADS-B***航迹点的修正方法能够有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
根据上述的一种基于ADS-B***航迹点的修正方法,本发明还提供一种基于ADS-B***航迹点的修正***,请参阅图4,为本发明基于ADS-B***航迹点的修正***结构图:
一种基于ADS-B***航迹点的修正***,包括预处理单元10、计算修正单元20;
所述预处理单元10对航迹点按接收时间进行排列;
所述计算修正单元20根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。
具体地,所述按接收时间排列航迹点是指将接收到的航迹点由大地坐标系转化为直角坐标系,再将航迹点的数据按照接收的时间是先后顺序进行排列。
具体地,所述计算修正单元20通过下述方程式进行计算:
P(k/k-1)=Φ(k-1)P(k-1/k-1)ΦT(k-1)+Q(k-1)
S(k)=H(k)P(k/k-1)HT(k)+R(k)
K(k)=r(k)P(k)HT(k)S-1(k)
P(k/k)=P(k/k-1)-K(k)S(k)KT(k)
其中,为当前时刻航迹点的状态预测值,Φ(k-1)为前一时刻状态转移矩阵,U(k-1)为前一时刻控制矩阵,为前一时刻机动加速度均值,为前一时刻航迹点的状态预测值;P(k/k-1)为当前时刻航迹点的状态预测协方差矩阵,Q(k-1)为噪声方差矩阵,P(k-1/k-1)为前一时刻航迹点的状态预测协方差矩阵,ΦT(k-1)为前一时刻状态转移矩阵的转置矩阵;为当前时刻航迹点的测量预测值,H(k)为当前时刻测量矩阵;S(k)为当前时刻航迹点的残差向量协方差矩阵,R(k)当前时刻观测噪声,HT(k)为当前时刻测量矩阵的转置矩阵;为当前时刻航迹点的新息,Y(k)为当前时刻航迹点的测量值,为当前时刻航迹点的测量预测值,d设置为3,r(k)为当前时刻航迹点的衰减因子;K(k)为当前时刻滤波器增益,S-1(k)为当前时刻航迹点的残差向量协方差矩阵的逆矩阵;为修正后的当前时刻航迹点的状态预测值,P(k/k)为修正后的当前航迹点的状态预测协方差矩阵,KT(k)为当前时刻滤波器增益转置矩阵。
进一步地:
前一时刻状态转移矩阵
α为机动频率,转弯机动频率α=1/60,逃避机动频率α=1/20,大气扰动机动频率α=1;T为采样时间;e为欧拉数;
前一时刻控制矩阵
当前时刻噪声方差矩阵
式中
应当指出的是,d的值也可以设置成其他大于零的自然数;在本发明方案中,d设置为3是一个识别当前时刻航迹点是否为野值较优的实施例。
较优地,在一个实施例中,当前时刻观测噪声R(k)的值可以为30,当前时刻测量矩阵H(k)=[100]。
通过调整滤波器衰减因子的大小(即r(k)),改变滤波器增益,实现了野值自适应修正。由上述方程式可以得到,野值的修正是通过衰减因子r(k)对增益进行调整实现的,调整范围为[0,1]。即是野值与预测偏离得越大,限制作用也越大,当非常大时,增益几乎接近于零,当处于正常值时,增益的值为1。
可以看到,本发明的基于ADS-B***航迹点的修正***,能够有效识别航迹点中的野值,实现对航迹点中的野值进行实时动态的修正,提高航迹点数据的准确度。
较优地,在一个实施例中,本发明的基于ADS-B***航迹点的修正***,还包括填充单元30;
所述填充单元将每两个航迹点的时间间隔与滤波器的采样时间间隔进行比较;若时间间隔不一致,则判断该两个航迹点之间存在航迹点丢失;用野值对丢失的航迹点进行填充。
具体地,所述填充单元对丢失的航迹点可以数值为0的野值进行填充,通过找出丢失的航迹点,用野值进行填充,能够保证航迹点数据的完整,在野值被修正后可以获得更准确的航迹点数据。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种基于ADS-B***航迹点的修正方法,其特征在于,包括步骤:
对航迹点按接收时间进行排列;
根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;
根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;
识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;
根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;
根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。
2.根据权利要求1所述的基于ADS-B***航迹点的修正方法,其特征在于,所述根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前航迹点的状态预测协方差矩阵通过下述方程式计算得到:
P(k/k-1)=Φ(k-1)P(k-1/k-1)ΦT(k-1)+Q(k-1)
其中,为当前时刻航迹点的状态预测值,P(k/k-1)为当前时刻航迹点的状态预测协方差矩阵,为前一时刻航迹点的状态预测值,P(k-1/k-1)为前一时刻航迹点的状态预测协方差矩阵;
所述航迹点状态信息包括前一时刻状态转移矩阵Φ(k-1)、前一时刻控制矩阵U(k-1)、前一时刻机动加速度均值前一时刻航迹点的状态预测协方差矩阵P(k/k-1)、前一时刻状态转移矩阵的转置矩阵ΦT(k-1)、前一时刻噪声方差矩阵Q(k-1)。
3.根据权利要求2所述的基于ADS-B***航迹点的修正方法,其特征在于,所述根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵通过下述方程式计算得到:
S(k)=H(k)P(k/k-1)HT(k)+R(k)
其中,为当前时刻航迹点的测量预测值,S(k)为当前时刻航迹点的残差向量协方差矩阵;
所述航迹点状态信息还包括当前时刻测量矩阵H(k)、当前时刻测量矩阵的转置矩阵HT(k)、当前时刻观测噪声R(k)。
4.根据权利要求3所述的基于ADS-B***航迹点的修正方法,其特征在于,所述识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子通过下述方程式计算得到:
其中,为当前时刻航迹点的新息,当时,当前时刻航迹点不是野值,当时,当前时刻航迹点为野值;Y(k)为当前时刻航迹点的测量值,为当前时刻航迹点的测量预测值,d设置为3,r(k)为当前时刻航迹点的衰减因子。
5.根据权利要求4所述的基于ADS-B***航迹点的修正方法,其特征在于,所述根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益通过下述方程式计算得到:
K(k)=r(k)P(k)HT(k)S-1(k)
其中,K(k)为当前时刻滤波器增益,S-1(k)为当前时刻航迹点的残差向量协方差矩阵的逆矩阵。
6.根据权利要求5所述的基于ADS-B***航迹点的修正方法,其特征在于,所述根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵通过下述方程式计算得到:
P(k/k)=P(k/k-1)-K(k)S(k)KT(k)
其中,为修正后的当前时刻航迹点的状态预测值,P(k/k)为修正后的当前航迹点的状态预测协方差矩阵,KT(k)为当前时刻滤波器增益转置矩阵。
7.根据权利要求1至6任意一项所述的基于ADS-B***航迹点的修正方法,其特征在于,在对航迹点按接收时间进行排列之后,预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵之前还包括步骤:
将每两个航迹点的时间间隔与滤波器的采样时间间隔进行比较;
若时间间隔不一致,则判断该两个航迹点之间存在航迹点丢失;
用野值对丢失的航迹点进行填充。
8.一种基于ADS-B***航迹点的修正***,其特征在于,包括预处理单元、计算修正单元;
所述预处理单元对航迹点按接收时间进行排列;
所述计算修正单元根据航迹点的状态信息预测当前时刻航迹点的状态预测值以及计算当前时刻航迹点的状态预测协方差矩阵;根据航迹点的状态信息预测当前时刻航迹点的测量预测值以及计算当前时刻航迹点的残差向量协方差矩阵;识别当前时刻航迹点是否为野值,并根据当前时刻航迹点是否为野值确定当前时刻航迹点的衰减因子;根据当前时刻航迹点的衰减因子计算当前时刻滤波器增益;根据当前时刻航迹点的测量预测值、当前航迹点的残差向量协方差矩阵以及当前时刻滤波器增益修正当前时刻航迹点的状态预测值以及当前航迹点的状态预测协方差矩阵。
9.根据权利要求8所述的基于ADS-B***航迹点的修正***,其特征在于,所述计算修正单元通过下述方程式进行计算:
P(k/k-1)=Φ(k-1)P(k-1/k-1)ΦT(k-1)+Q(k-1)
S(k)=H(k)P(k/k-1)HT(k)+R(k)
K(k)=r(k)P(k)HT(k)S-1(k)
P(k/k)=P(k/k-1)-K(k)S(k)KT(k)
其中,为当前时刻航迹点的状态预测值,Φ(k-1)为前一时刻状态转移矩阵,U(k-1)为前一时刻控制矩阵,为前一时刻机动加速度均值,为前一时刻航迹点的状态预测值;P(k/k-1)为当前时刻航迹点的状态预测协方差矩阵,Q(k-1)为噪声方差矩阵,P(k-1/k-1)为前一时刻航迹点的状态预测协方差矩阵,ΦT(k-1)为前一时刻状态转移矩阵的转置矩阵;为当前时刻航迹点的测量预测值,H(k)为当前时刻测量矩阵;S(k)为当前时刻航迹点的残差向量协方差矩阵,R(k)当前时刻观测噪声,HT(k)为当前时刻测量矩阵的转置矩阵;为当前时刻航迹点的新息,Y(k)为当前时刻航迹点的测量值,为当前时刻航迹点的测量预测值,d设置为3,r(k)为当前时刻航迹点的衰减因子;K(k)为当前时刻滤波器增益,S-1(k)为当前时刻航迹点的残差向量协方差矩阵的逆矩阵;为修正后的当前时刻航迹点的状态预测值,P(k/k)为修正后的当前航迹点的状态预测协方差矩阵,KT(k)为当前时刻滤波器增益转置矩阵。
10.根据权利要求8所述的基于ADS-B***航迹点的修正***,其特征在于,还包括填充单元;
所述填充单元将每两个航迹点的时间间隔与滤波器的采样时间间隔进行比较;若时间间隔不一致,则判断该两个航迹点之间存在航迹点丢失;用野值对丢失的航迹点进行填充。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410412785.3A CN104180800B (zh) | 2014-08-20 | 2014-08-20 | 基于ads‑b***航迹点的修正方法和*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410412785.3A CN104180800B (zh) | 2014-08-20 | 2014-08-20 | 基于ads‑b***航迹点的修正方法和*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104180800A true CN104180800A (zh) | 2014-12-03 |
CN104180800B CN104180800B (zh) | 2017-04-12 |
Family
ID=51962011
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410412785.3A Active CN104180800B (zh) | 2014-08-20 | 2014-08-20 | 基于ads‑b***航迹点的修正方法和*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104180800B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105425254A (zh) * | 2015-12-28 | 2016-03-23 | 西北工业大学 | 动态gnss测量数据的抗野值双向平滑滤波方法 |
CN105894117A (zh) * | 2016-03-31 | 2016-08-24 | 北京航空航天大学 | 航迹预测方法及装置 |
CN106204681A (zh) * | 2016-07-28 | 2016-12-07 | 中国电子科技集团公司第二十八研究所 | 一种空间坐标系下的高精度航迹点显示与控制方法 |
CN109990789A (zh) * | 2019-03-27 | 2019-07-09 | 广东工业大学 | 一种飞行导航方法、装置及相关设备 |
CN110807027A (zh) * | 2019-11-05 | 2020-02-18 | 上海眼控科技股份有限公司 | 野值处理方法、装置、设备及存储介质 |
CN113111142A (zh) * | 2021-03-23 | 2021-07-13 | 中国人民解放军91388部队 | 指显平台对水下目标航迹野值的实时处理方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090248287A1 (en) * | 2008-02-15 | 2009-10-01 | Kutta Technologies, Inc. | Unmanned aerial system position reporting system and related methods |
CN101577058A (zh) * | 2009-05-26 | 2009-11-11 | 民航数据通信有限责任公司 | 支持广播式交通信息服务的数据处理方法 |
CN101655561A (zh) * | 2009-09-14 | 2010-02-24 | 南京莱斯信息技术股份有限公司 | 基于联合卡尔曼滤波的多点定位数据与雷达数据融合方法 |
US20100070180A1 (en) * | 2008-08-04 | 2010-03-18 | Ridenour Richard D | Systems and methods for conflict detection using position uncertainty |
CN102141609A (zh) * | 2010-12-28 | 2011-08-03 | 哈尔滨工业大学 | 一种高频段一阶Bragg峰及其***谱峰的识别方法及*** |
CN102226838A (zh) * | 2011-03-30 | 2011-10-26 | 安徽四创电子股份有限公司 | 具有ads-b功能的s模式二次雷达编解码*** |
CN202549080U (zh) * | 2012-03-16 | 2012-11-21 | 中国民用航空总局第二研究所 | 一种雷达数据、飞行计划数据与ads-b数据融合*** |
-
2014
- 2014-08-20 CN CN201410412785.3A patent/CN104180800B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090248287A1 (en) * | 2008-02-15 | 2009-10-01 | Kutta Technologies, Inc. | Unmanned aerial system position reporting system and related methods |
US20100070180A1 (en) * | 2008-08-04 | 2010-03-18 | Ridenour Richard D | Systems and methods for conflict detection using position uncertainty |
CN101577058A (zh) * | 2009-05-26 | 2009-11-11 | 民航数据通信有限责任公司 | 支持广播式交通信息服务的数据处理方法 |
CN101655561A (zh) * | 2009-09-14 | 2010-02-24 | 南京莱斯信息技术股份有限公司 | 基于联合卡尔曼滤波的多点定位数据与雷达数据融合方法 |
CN102141609A (zh) * | 2010-12-28 | 2011-08-03 | 哈尔滨工业大学 | 一种高频段一阶Bragg峰及其***谱峰的识别方法及*** |
CN102226838A (zh) * | 2011-03-30 | 2011-10-26 | 安徽四创电子股份有限公司 | 具有ads-b功能的s模式二次雷达编解码*** |
CN202549080U (zh) * | 2012-03-16 | 2012-11-21 | 中国民用航空总局第二研究所 | 一种雷达数据、飞行计划数据与ads-b数据融合*** |
Non-Patent Citations (2)
Title |
---|
张召悦等: "《基于基本飞行模型的ADS-B航迹修正研究》", 《中国民航大学学报 》 * |
徐亚军等: "《基于ADS-B趋势信息的民航飞机跟踪算法》", 《电讯技术》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105425254A (zh) * | 2015-12-28 | 2016-03-23 | 西北工业大学 | 动态gnss测量数据的抗野值双向平滑滤波方法 |
CN105894117A (zh) * | 2016-03-31 | 2016-08-24 | 北京航空航天大学 | 航迹预测方法及装置 |
CN106204681A (zh) * | 2016-07-28 | 2016-12-07 | 中国电子科技集团公司第二十八研究所 | 一种空间坐标系下的高精度航迹点显示与控制方法 |
CN109990789A (zh) * | 2019-03-27 | 2019-07-09 | 广东工业大学 | 一种飞行导航方法、装置及相关设备 |
CN110807027A (zh) * | 2019-11-05 | 2020-02-18 | 上海眼控科技股份有限公司 | 野值处理方法、装置、设备及存储介质 |
CN113111142A (zh) * | 2021-03-23 | 2021-07-13 | 中国人民解放军91388部队 | 指显平台对水下目标航迹野值的实时处理方法 |
CN113111142B (zh) * | 2021-03-23 | 2024-02-02 | 中国人民解放军91388部队 | 指显平台对水下目标航迹野值的实时处理方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104180800B (zh) | 2017-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104180800A (zh) | 基于ads-b***航迹点的修正方法和*** | |
CN105116392B (zh) | 一种针对ais与主动雷达航迹融合及识别的方法 | |
EP2490199B1 (en) | Method for selecting meteorological data for updating an aircraft trajectory | |
US8200377B2 (en) | System for securing an aircraft flight plan | |
CN103336863B (zh) | 基于雷达飞行航迹观测数据的飞行意图识别方法 | |
CN108645413A (zh) | 一种移动机器人的同时定位与地图创建的动态纠正方法 | |
CN105334495B (zh) | 一种无线网络中基于信号到达时间的非视距稳健定位方法 | |
RU2013110010A (ru) | Адаптивный способ для оценки электронного содержания ионосферы | |
CN103345587B (zh) | Ads‑b监视数据与雷达航迹的直觉模糊关联方法、装置 | |
CN104730510A (zh) | 一种多雷达航迹融合方法 | |
CN103941233A (zh) | 一种多平台主被动传感器协同跟踪的雷达间歇交替辐射控制方法 | |
CN102540177B (zh) | 一种基于三维射线追踪算法的目标定位方法 | |
CN104077928A (zh) | 适用于航路外无规律飞行的通航过点位置信息更新方法 | |
CN104793201A (zh) | 一种跟踪临近空间高超声速目标的修正变结构网格交互多模型滤波方法 | |
CN104180801B (zh) | 基于ads‑b***航迹点的预测方法和*** | |
CN109357675A (zh) | 基于卡尔曼滤波的记忆跟踪算法 | |
CN101630445B (zh) | 基于噪声误差的异步多传感器数据处理方法和*** | |
CN104101869B (zh) | 一种极坐标下的地波雷达运动目标仿真建模方法 | |
CN106412817B (zh) | 一种移动终端的定位方法及其装置 | |
CN107621632A (zh) | 用于nshv跟踪滤波的自适应滤波方法及*** | |
CN107643083A (zh) | 基于轨迹预报的空间目标中断航迹关联方法 | |
CN107390166B (zh) | 一种自适应干扰源定位飞行校验方法 | |
CN102508217A (zh) | 建立雷达测量误差标定模型的方法 | |
CN102967770A (zh) | 一种基于混沌pso算法的雷电定位方法 | |
CN106324600A (zh) | 风场测量方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |