CN108490429B - Tws雷达多目标跟踪方法及系统 - Google Patents
Tws雷达多目标跟踪方法及系统 Download PDFInfo
- Publication number
- CN108490429B CN108490429B CN201810120330.2A CN201810120330A CN108490429B CN 108490429 B CN108490429 B CN 108490429B CN 201810120330 A CN201810120330 A CN 201810120330A CN 108490429 B CN108490429 B CN 108490429B
- Authority
- CN
- China
- Prior art keywords
- observation
- state
- prediction
- covariance
- time
- 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
- 238000000034 method Methods 0.000 claims abstract description 66
- 238000004364 calculation method Methods 0.000 claims abstract description 36
- 239000011159 matrix material Substances 0.000 claims description 52
- 230000007704 transition Effects 0.000 claims description 18
- 238000004422 calculation algorithm Methods 0.000 description 42
- 238000010586 diagram Methods 0.000 description 19
- 238000012790 confirmation Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000001914 filtration Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000003672 processing method Methods 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011423 initialization method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
- G01S13/726—Multiple target tracking
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种TWS雷达多目标跟踪方法及系统,其中方法包括:初步间隔计算步骤、计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;状态更新步骤、根据初步间隔计算步骤中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。本发明利用落入波门内的观测进一步估计重访间隔,建立了一个新的边扫描边跟踪雷达中求解重访间隔的模型,解决了TWS雷达中重访时间间隔不确定的问题,提高了TWS雷达的跟踪性能,实现了精确跟踪。
Description
技术领域
本发明涉及雷达目标跟踪技术领域,尤其涉及一种TWS雷达多目标跟踪方法及系统。
背景技术
边跟踪边扫描(TWS)雷达因其独特的工作方式被广泛应用于很多场合,如机械扫描雷达和跟踪数据率与搜索数据率相同的相控阵扫描雷达。实际的TWS雷达每次获得观测的时间并非天线扫描周期的整数倍,根据目标的运动特性,当目标的运动方向与天线的扫描方向相同时,目标的重访间隔会大于天线扫描周期;当目标的运动方向与天线的扫描方向相反时,目标的重访间隔会小于天线扫描周期。在跟踪远距离的目标时,目标的重访时间间隔与天线扫描周期近似相等,跟踪误差可以忽略;而在跟踪近距离,尤其是高速运动的目标时,目标的重访时间间隔与天线扫描周期之间相差很大,除了影响跟踪精度外,严重时会导致点迹和航迹的错误关联,甚至跟丢目标。因为重访间隔的不准确,波门预选时会导致真实观测没有落入波门内,在复杂环境下更是会引入虚假观测,从而导致“点航”的错误关联。
现有技术中提出了一种方法,通过对点迹和雷达扫描之间相对速度的计算,根据目标的运动特性(相对于雷达扫描方向是同向还是反向),动态地实时计算出航迹应该预测的时间,来估计航迹下次应该出现的位置。但是该方法的缺点是将目标的角度与角速度和时间之间的关系看成单纯的线性关系,与实际情况不符。现有技术中还提出了另一种方法,由机械扫描雷达在处理跟踪问题时,将整个扫描区域划分成扇区,用每个扇区的结束时间作为该扇区内所有观测的重访间隔。该方法在一定程度上减少了真实的重访间隔与所用重访间隔的差别,提高了跟踪精度,但是这样的处理方式对扇区内所有的观测“一概而论”,以偏概全,仍有不足之处。因此,仍然需要一个新的方法,有效地建立TWS雷达的重访时间间隔模型,并运用于后续的跟踪中,以实现精确跟踪。
发明内容
本发明要解决的技术问题在于,针对现有的TWS雷达在进行边扫描边跟踪时存在的重访间隔不确定的问题,提出了一种新的TWS雷达多目标跟踪方法及系统,利用落入波门内的观测进一步估计重访间隔,提高了TWS雷达的跟踪性能。
为了解决上述技术问题,本发明第一方面,提供了一种TWS雷达多目标跟踪方法,包括以下步骤:
初步间隔计算步骤、计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;
状态更新步骤、根据初步间隔计算步骤中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
在根据本发明所述的TWS雷达多目标跟踪方法中,优选地,所述初步间隔计算步骤包括以下步骤:
(1)计算状态的一步预测和一步预测协方差P(k+1|k);
(2)根据步骤(1)获得的状态的一步预测和一步预测协方差计算观测的一步预测和新息协方差S(k+1);
(3)根据步骤(2)获得的观测的一步预测和新息协方差S(k+1)计算统计距离d;判断统计距离d是否不大于预设的门限γ,是则计算重访时间间隔其中ti(k+1)为观测时间,为k时刻状态估计的时间;否则扩大波门直至观测落入波门内。
在根据本发明所述的TWS雷达多目标跟踪方法中,优选地,所述状态更新步骤包括以下步骤:
(1)根据初步间隔计算步骤中获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k);
(2)根据步骤(1)中获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k):
(3)根据步骤(2)获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1);
(4)根据步骤(3)获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,转步骤(5),否则看成杂波或者虚警不予考虑;
(5)利用落入波门内的观测进行状态更新。
本发明第二方面,提供了一种TWS雷达多目标跟踪系统,包括:
初步间隔计算模块,用于计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;
状态更新模块,用于根据初步间隔计算模块中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
在根据本发明所述的TWS雷达多目标跟踪系统中,优选地,所述初步间隔计算模块包括:
第一状态预测单元,用于计算状态的一步预测和一步预测协方差P(k+1|k):
第一观测预测单元,用于根据第一状态预测单获得的状态的一步预测和一步预测协方差计算观测的一步预测和新息协方差S(k+1);
第一波门预选单元,根据第一观测预测单元获得的观测的一步预测和新息协方差S(k+1)计算统计距离d;判断统计距离d是否不大于预设的门限γ,是则计算重访时间间隔其中ti(k+1)为观测时间,为k时刻状态估计的时间;否则扩大波门直至观测落入波门内。
在根据本发明所述的TWS雷达多目标跟踪系统中,优选地,所述状态更新模块包括:
矩阵重写单元,用于根据初步间隔计算模块获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k);
第二状态预测单元,用于根据矩阵重新单元获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k);
第二观测预测单元,用于根据第二状态预测单元获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1);
第二波门预选单元,用于根据第二观测预测单元获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,并利用落入波门内的观测进行状态更新,否则看成杂波或者虚警不予考虑。
实施本发明的TWS雷达多目标跟踪方法及系统,具有以下有益效果:本发明提出了一种准确可靠的TWS雷达多目标跟踪方法,相比传统的TWS雷达跟踪方法,本发明提出了利用落入波门内的观测进一步估计重访间隔的方法,建立了一个新的边扫描边跟踪雷达中求解重访间隔的模型,解决了TWS雷达中重访时间间隔不确定的问题,提高了TWS雷达的跟踪性能,实现了精确跟踪。
附图说明
图1为根据本发明第一实施例的TWS雷达多目标跟踪方法的流程图;
图2为根据本发明第二实施例的TWS雷达多目标跟踪方法的流程图;
图3为根据本发明优选实施例的TWS雷达多目标跟踪系统的模块框图;
图4为单目标运动不同算法位置分量的均方根误差图;
图5为单目标运动不同算法速度分量的均方根误差图;
图6为单目标运动不同算法时间分量的均方根误差图;
图7为多目标运动不同算法位置分量的均方根误差图;
图8为多目标运动不同算法速度分量的均方根误差图;
图9为多目标运动不同算法时间分量的均方根误差图;
图10为真实目标的确认数目对比图;
图11为虚假航迹的确认数目图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明针对TWS雷达中重访时间间隔不准确的问题,本发明提出了一种新的重访间隔估计方法,精确估计重访间隔,提高TWS雷达的跟踪精度,继而提供了一种TWS雷达多目标跟踪方法及系统。本发明的主要思想是利用落入波门内的观测时间与上一个时刻更新的状态时间相减,令这个时间差值为该观测的重访间隔,重新进行跟踪滤波,最后将重新更新的状态向量加权融合,作为最终的状态更新输出。
请参阅图1,为根据本发明第一实施例的TWS雷达多目标跟踪方法的流程图。如图1所示,该实施例提供的TWS雷达多目标跟踪方法包括以下步骤:
首先,在步骤S101中,执行初步间隔计算步骤:计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;
随后,在步骤S102中,执行状态更新步骤:根据初步间隔计算步骤中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
请参阅图2,为根据本发明第二实施例的TWS雷达多目标跟踪方法的流程图。如图2所示,该实施例提供的TWS雷达多目标跟踪方法包括以下步骤:
首先,在步骤S201中,流程开始;
随后,在步骤S202中,输入k时刻的状态和天线转动周期T;
随后,在步骤S203~S208中执行初步间隔计算步骤:
在步骤S203中,计算状态的一步预测和一步预测协方差P(k+1|k):
P(k+1|k)=F(k)P(k|k)F(k)′+Γ(k)q(k)Γ(k)′;
其中,为k+1时刻状态的一步预测,为k时刻状态的更新值,F(k)为k时刻的状态转移矩阵,P(k+1|k)为k+1时刻状态的一步预测协方差,P(k|k)为k时刻的更新协方差,F(k)′为F(k)的转置,Γ(k)为k时刻的过程噪声分布矩阵,Γ(k)′为Γ(k)的转置;q(k)为k时刻的过程噪声的标准差。
在步骤S204中,根据步骤S203获得的状态的一步预测和一步预测协方差,计算观测的一步预测和新息协方差:
S(k+1)=H(k+1)P(k+1|k)H(k+1)′+R(k+1)
其中,为k+1时刻的观测的一步预测,H(k+1)为k+1时刻的观测矩阵,为k+1时刻状态的一步预测,S(k+1)为k+1时刻观测的新息协方差,P(k+1|k)为k+1时刻状态的一步预测协方差,H(k+1)′为观测矩阵的转置,R(k+1)为k+1时刻观测噪声的协方差阵。
在步骤S205中,执行波门预选步骤:根据步骤S204获得的观测的一步预测和新息协方差S(k+1)计算统计距离d:
令门限为γ。
其中,z为k+1时刻的观测集。
在步骤S206中,判断统计距离d与预设的门限γ的大小:
1)当d≤γ时,观测落入波门内,转步骤S208求解出观测时间:
其中mk为落入波门内的观测个数,T和ωradar分别为天线转动周期和天线转动的角速度;xi,yi分别为第i个观测的位置;
计算重访时间间隔,即其中为k时刻状态估计的时间。
2)当d>γ时,判断观测没有落入波门内,转步骤S207继续扩大波门(可以扩大门限值γ),直至有观测落入波门为止。当有观测落入波门后,处理方法与1)相同。
随后,在步骤S209~S213中执行状态更新步骤:
在步骤S209中,根据初步间隔计算步骤中获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k):
对于匀速直线运动(CV)来说,二者分别重写如下:
式中为初步间隔计算步骤中计算得到的重访时间间隔。
在步骤S210中,根据步骤S209中获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k):
Pi(k+1|k)=Fi(k)P(k|k)Fi(k)′+Γi(k)q(k)Γi(k)′;
在步骤S211中,根据步骤S210获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1);
S(k+1)=H(k+1)Pi(k+1|k)H(k+1)′+R(k+1);
在步骤S212中,根据步骤S211获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;
其中,z为k+1时刻的观测集。
判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,转步骤S213,否则看成杂波或者虚警不予考虑;
在步骤S213中,利用落入波门内的观测进行状态更新,包括:
A、通过以下公式得到最终状态更新输出值:
其中,为第i次状态更新值,Ki(k+1)=Pi(k+1|k)H(k+1)′·S(k+1)-1为增益;
βj(k+1)为互联概率,其表达式为:
其中:
PD为目标的检测概率,PG为门概率,νj(k+1)为观测残差,具体表示为Z(k+1)为k+1时刻的观测集,为观测的一步预测,H(k+1)′为观测矩阵的转置;
B、通过以下公式得到最终状态协方差更新输出值:
其中,Pi(k+1|k+1)为第i次状态协方差更新值;
Pc(k+1|k+1)=[I-K(k+1)H(k+1)]P(k+1|k);
其中K(k+1)为增益,H(k+1)为观测矩阵;
c、通过以下公式得到k+1时刻的重访时间更新输出值:
其中为初步间隔计算步骤中计算得到的重访时间间隔,ti(k+1)为k+1时刻落入波门内的观测时间,xk+1,yk+1分别为k+1时刻x,y方向的位置,T为天线扫描周期;βi(k+1)为互联概率。
在步骤S214中,流程结束。
请参阅图3,为根据本发明优选实施例的TWS雷达多目标跟踪系统的模块框图。如图3所示,该实施例提供的系统300包括:初步间隔计算模块301和状态更新模块302。
其中,初步间隔计算模块301用于计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止。
状态更新模块302用于根据初步间隔计算模块301获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
优选地,初步间隔计算模块301包括:第一状态预测单元、第一观测预测单元和第一波门预选单元。
其中,第一状态预测单元用于计算状态的一步预测和一步预测协方差P(k+1|k)。该第一状态预测单元的计算过程与前述方法中步骤S203中一致,在此不再进行赘述。
第一观测预测单元用于根据第一状态预测单获得的状态的一步预测和一步预测协方差计算观测的一步预测和新息协方差S(k+1)。该第一观测预测单元的计算过程与前述方法中步骤S204中一致,在此不再进行赘述。
第一波门预选单元用于根据第一观测预测单元获得的观测的一步预测和新息协方差S(k+1)计算统计距离d;判断统计距离d是否不大于预设的门限γ,是则计算重访时间间隔其中ti(k+1)为观测时间,为k时刻状态估计的时间;否则扩大波门直至观测落入波门内。该第一波门预选单元的计算过程与前述方法中步骤S205~S208中一致,在此不再进行赘述。
优选地,状态更新模块302包括:矩阵重写单元、第二状态预测单元、第二观测预测单元和第二波门预选单元。
矩阵重写单元用于根据初步间隔计算模块获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)。该矩阵重写单元的计算过程与前述方法中步骤S209中一致,在此不再进行赘述。
第二状态预测单元用于根据矩阵重新单元获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k)。该第二状态预测单元的计算过程与前述方法中步骤S210中一致,在此不再进行赘述。
第二观测预测单元,用于根据第二状态预测单元获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1)。该第二观测预测单元的计算过程与前述方法中步骤S211中一致,在此不再进行赘述。
第二波门预选单元,用于根据第二观测预测单元获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,并利用落入波门内的观测进行状态更新,否则看成杂波或者虚警不予考虑。该第二波门预选单元的计算过程与前述方法中步骤S212~S213中一致,在此不再进行赘述。
下面对本发明的具体应用实例进行介绍。
1.有效性分析
请参阅图4,为单目标运动不同算法位置分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对单目标分别进行观测重选算法和传统的跟踪算法求出的位置分量的RMSE对比图,从图中可以看出本发明的观测重选算法在10到40步的跟踪精度明显优于传统的跟踪算法,而后趋于平稳。
请参阅图5,为单目标运动不同算法速度分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对单目标分别进行观测重选算法和传统的跟踪算法求出的速度分量的RMSE对比图,从图中可以看出本发明的观测重选算法的跟踪精度一直优于传统的跟踪算法。
请参阅图6,为单目标运动不同算法时间分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对单目标分别进行观测重选算法和传统的跟踪算法求出的时间分量的RMSE对比图,从图中可以看出本发明的观测重选算法的时间估计精度与传统的跟踪算法的相比,有着显著提升。
请参阅图7,为多目标运动不同算法位置分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对多目标分别进行观测重选算法和传统的跟踪算法求出的位置分量的RMSE对比图,二者在位置的跟踪精度区别不是很明显,但是本发明的观测重选算法的精度仍略优于传统的跟踪算法。
请参阅图8,为多目标运动不同算法速度分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对多目标分别进行观测重选算法和传统的跟踪算法求出的速度分量的RMSE对比图,从图中可以看出本发明的观测重选算法的速度估计精度优于传统的跟踪算法。
请参阅图9,为多目标运动不同算法时间分量的均方根误差(RMSE)图。该图为100次蒙特卡洛下对多目标分别进行观测重选算法和传统的跟踪算法求出的时间分量的RMSE对比图,从图中可以看出本发明的观测重选算法的时间精度相较于传统的跟踪算法的精度有大幅提升。
请参阅图10,为真实目标的确认数目对比图。该图为100次蒙特卡洛下观测重选算法和传统的跟踪算法的真实目标的确认数目对比图,可以看出本发明的观测重选算法确认真实航迹的收敛速度明显快于传统的跟踪算法,且在前期确认真实航迹的能力优于传统的跟踪算法。
请参阅图11,为虚假航迹的确认数目图。该图为100次蒙特卡洛下观测重选算法和传统的跟踪算法的虚假航迹的确认数目对比图,可以看出前期传统的跟踪算法所求得的虚假航迹明显高于观测重选算法,与图10中所示内容相对应。
2、具体模拟实例
在进行仿真实验时,假设目标进行匀速直线运动,其状态转移方程和观测方程分别为:
X(k+1)=F(k)X(k)+Γ(k)·v(k);
Z(k+1)=h(X(k+1))+W(k+1);
其中状态转移矩阵F(k)可以表示为
过程噪声为零均值的高斯白噪声,其分布矩阵Γ(k)可表示为
而观测方程中的r与α分别表示目标的径向距离和方位角。量测噪声是零均值的高斯白噪声,协方差
仿真实验中的具体场景设置如下:
1)单目标:
目标的初始位置为X1=[4000 -20 4000 20],目标观测的检测概率为0.9,过程噪声标准差为10-3(m/s2),雷达的观测噪声的距离标准差为20m,角度标准差为0.001rad。天线转动周期T=20s,共60次扫描,进行100次的蒙特卡洛仿真。
1)多目标:
假设有三条航迹,起始位置分别为:
X0=[5000 10 4000 -20]
X1=[4000 -20 4000 20]
X2=[4000 15 3000 -15]
目标观测的检测概率为0.9,过程噪声标准差为10-3(m/s2),雷达的观测噪声的距离标准差为20m,角度标准差为0.001rad。天线扫描周期T=20s,共60次扫描。采用两点差分初始化方法初始化航迹,其中最大速度200m/s,航迹的初始存在概率为P0=0.05,航迹的确认门限为tc=0.95,航迹的终结门限td=0.03。
仿真实验的具体实现步骤如下:
第一步:初始化
初始化前两个坐标点,滤波从第三点开始。针对两坐标雷达的数据处理问题,系统的状态向量表示为而直角坐标系下的量测值z(k)为
其中,r和θ分别为极坐标系下雷达的目标径向距离和方位角测量数据。那么系统的初始状态可利用前两个时刻的测量值z(0)和z(1)来确定,即
k时刻量测噪声在直角坐标系下的协方差为:
其中:和分别为径向距离和方位角测量误差的协方差,而
由量测噪声协方差的各元素可得四维状态向量情况下的初始协方差阵为:
并且滤波器从第三个点开始滤波。
第二步:计算状态的一步预测和一步预测协方差P(k+1|k):
P(k+1|k)=F(k)P(k|k)F(k)′+Γ(k)q(k)Γ(k)′
其中,q(k)为过程噪声的标准差。
第三步:计算观测的一步预测和新息协方差S(k+1):
S(k+1)=H(k+1)P(k+1|k)H(k+1)′+R(k+1);
其中,R(k+1)为观测噪声的协方差阵。
第四步:波门预选:
求解统计距离令门限为γ,有两种情况:
1)当d≤γ时,观测落入波门内,求解出观测的时间其中mk为落入波门内的观测个数,T和ωradar分别为天线转动周期和天线转动的角速度。重访间隔其中为k时刻状态估计的时间。
2)当d>γ时,观测没有落入波门内,继续扩大波门(可以扩大门限值γ),直至有观测落入波门为止。当有观测落入波门后,处理方法与1)相同。
第五步:重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)
对于匀速直线运动(CV)来说,二者分别重写如下:
第七步:计算新的一步预测和一步预测协方差Pi(k+1|k):
Pi(k+1|k)=Fi(k)P(k|k)Fi(k)′+Γi(k)q(k)Γi(k)′;
第八步:计算新的一步预测和新息协方差S(k+1):
S(k+1)=H(k+1)Pi(k+1|k)H(k+1)′+R(k+1);
第九步:波门预选
按照第四步中的方法求解出统计距离,再与门限比较。当统计距离小于门限时,则观测落入波门内,否则,看成杂波或者虚警不予考虑。
第十步:利用落入波门内的观测进行状态更新:
1)状态更新:
第i次状态更新值:
最终状态更新输出值:
其中,Ki(k+1)=Pi(k+1|k)H(k+1)′·S(k+1)-1为增益,βj(k+1)为互联概率,其表达式
为同时有
2)状态协方差更新:
第i次状态协方差更新值:
最终状态协方差更新输出值:
其中,Pc(k+1|k+1)=[I-K(k+1)H(k+1)]P(k+1|k),
3)时间更新:
其中为估计的重访时间间隔,ti(k+1)为k+1时刻落入波门内的观测的时间,
应该理解地是,本发明中TWS雷达多目标跟踪方法及系统的原理相同,因此对TWS雷达多目标跟踪方法的实施例的详细阐述也适用于TWS雷达多目标跟踪系统。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种TWS雷达多目标跟踪方法,其特征在于,包括以下步骤:
初步间隔计算步骤、计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;
状态更新步骤、根据初步间隔计算步骤中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
2.根据权利要求1所述的TWS雷达多目标跟踪方法,其特征在于,所述初步间隔计算步骤包括以下步骤:
(1)计算状态的一步预测和一步预测协方差P(k+1|k);
(2)根据步骤(1)获得的状态的一步预测和一步预测协方差计算观测的一步预测和新息协方差S(k+1);
(3)根据步骤(2)获得的观测的一步预测和新息协方差S(k+1)计算统计距离d;判断统计距离d是否不大于预设的门限γ,是则计算重访时间间隔其中ti(k+1)为观测时间,为k时刻状态估计的时间;否则扩大波门直至观测落入波门内。
3.根据权利要求2所述的TWS雷达多目标跟踪方法,其特征在于,所述状态更新步骤包括以下步骤:
(1)根据初步间隔计算步骤中获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k);
(2)根据步骤(1)中获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k):
(3)根据步骤(2)获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1);
(4)根据步骤(3)获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,转步骤(5),否则看成杂波或者虚警不予考虑;
(5)利用落入波门内的观测进行状态更新。
4.根据权利要求2所述的TWS雷达多目标跟踪方法,其特征在于,所述状态更新步骤中利用落入波门内的观测进行状态更新的步骤包括:
A、通过以下公式得到最终状态更新输出值:
其中,mk为落入波门内的观测个数,为第i次状态更新值,Ki(k+1)=Pi(k+1|k)H(k+1)′·S(k+1)-1为增益,βj(k+1)为互联概率,νj(k+1)为观测残差,具体表示为Z(k+1)为k+1时刻的观测集,为观测的一步预测,H(k+1)′为观测矩阵的转置;
B、通过以下公式得到最终状态协方差更新输出值:
其中,Pi(k+1|k+1)为第i次状态协方差更新值;
c、通过以下公式得到k+1时刻的重访时间更新输出值:
其中为初步间隔计算步骤中计算得到的重访时间间隔,ti(k+1)为k+1时刻落入波门内的各个观测的时间,xk+1,yk+1分别为k+1时刻x,y方向的位置,T为天线扫描周期;βi(k+1)为互联概率。
5.根据权利要求3所述的TWS雷达多目标跟踪方法,其特征在于,所述状态更新步骤中对于匀速直线运动通过以下公式重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k):
其中,为初步间隔计算步骤中计算得到的重访时间间隔。
6.一种TWS雷达多目标跟踪系统,其特征在于,包括:
初步间隔计算模块,用于计算目标的统计距离,并判断统计距离是否落入波门范围内,是则计算观测时间与上一时刻状态估计的时间的差值作为重访时间间隔;否则扩大波门直至观测落入波门为止;
状态更新模块,用于根据初步间隔计算模块中获得的重访时间间隔重新计算目标的统计距离,并判断新的统计距离是否落入波门范围内,是则利用落入波门内的观测进行状态更新。
7.根据权利要求6所述的TWS雷达多目标跟踪系统,其特征在于,所述初步间隔计算模块包括:
第一状态预测单元,用于计算状态的一步预测和一步预测协方差P(k+1|k):
第一观测预测单元,用于根据第一状态预测单元获得的状态的一步预测和一步预测协方差计算观测的一步预测和新息协方差S(k+1);
第一波门预选单元,根据第一观测预测单元获得的观测的一步预测和新息协方差S(k+1)计算统计距离d;判断统计距离d是否不大于预设的门限γ,是则计算重访时间间隔其中ti(k+1)为观测时间,为k时刻状态估计的时间;否则扩大波门直至观测落入波门内。
8.根据权利要求7所述的TWS雷达多目标跟踪系统,其特征在于,所述状态更新模块包括:
矩阵重写单元,用于根据初步间隔计算模块获得的重访时间间隔重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k);
第二状态预测单元,用于根据矩阵重写单元获得的新的状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k)计算状态的一步预测和一步预测协方差P(k+1|k);
第二观测预测单元,用于根据第二状态预测单元获得的新的状态的一步预测和一步预测协方差计算新的一步预测和新息协方差S(k+1);
第二波门预选单元,用于根据第二观测预测单元获得的新的一步预测和新息协方差S(k+1)计算新的统计距离d;判断新的统计距离d是否不大于预设的门限γ,是则判断观测落入波门内,并利用落入波门内的观测进行状态更新,否则看成杂波或者虚警不予考虑。
9.根据权利要求8所述的TWS雷达多目标跟踪系统,其特征在于,所述第二波门预选单元利用落入波门内的观测进行状态更新的步骤包括:
A、通过以下公式得到最终状态更新输出值:
其中,mk为落入波门内的观测个数,为第i次状态更新值,Ki(k+1)=Pi(k+1|k)H(k+1)′·S(k+1)-1为增益,βj(k+1)为互联概率,νj(k+1)为观测残差,具体表示为Z(k+1)为k+1时刻的观测集,为观测的一步预测,H(k+1)′为观测矩阵的转置;
B、通过以下公式得到最终状态协方差更新输出值:
其中,Pi(k+1|k+1)为第i次状态协方差更新值;
c、通过以下公式得到k+1时刻的重访时间更新输出值:
其中为初步间隔计算模块中计算得到的重访时间间隔,ti(k+1)为k+1时刻落入波门内的各个观测的时间,xk+1,yk+1分别为x,y方向的位置,T为天线扫描周期;βi(k+1)为互联概率。
10.根据权利要求8所述的TWS雷达多目标跟踪系统,其特征在于,所述矩阵重写单元对于匀速直线运动通过以下公式重写状态转移矩阵Fi(k)和过程噪声分布矩阵Γi(k):
其中,为初步间隔计算步骤中计算得到的重访时间间隔。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810120330.2A CN108490429B (zh) | 2018-02-07 | 2018-02-07 | Tws雷达多目标跟踪方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810120330.2A CN108490429B (zh) | 2018-02-07 | 2018-02-07 | Tws雷达多目标跟踪方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108490429A CN108490429A (zh) | 2018-09-04 |
CN108490429B true CN108490429B (zh) | 2019-05-07 |
Family
ID=63344624
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810120330.2A Active CN108490429B (zh) | 2018-02-07 | 2018-02-07 | Tws雷达多目标跟踪方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108490429B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021138220A1 (en) * | 2019-12-30 | 2021-07-08 | Lyft, Inc. | Systems and methods for adaptive gating in initialization of radar tracking |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113406618B (zh) * | 2021-06-22 | 2022-10-25 | 哈尔滨工业大学 | 一种tws雷达多目标连续跟踪方法 |
CN115877328B (zh) * | 2023-03-06 | 2023-05-12 | 成都鹰谷米特科技有限公司 | 一种阵列雷达的信号收发方法及阵列雷达 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101770024A (zh) * | 2010-01-25 | 2010-07-07 | 上海交通大学 | 多目标跟踪方法 |
CN106226751A (zh) * | 2016-07-08 | 2016-12-14 | 西安电子科技大学 | 基于dp‑tbd的机动目标检测与跟踪方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7898466B1 (en) * | 2008-12-08 | 2011-03-01 | Lockheed Martin Corporation | Optimization of radar resources |
CN104007419B (zh) * | 2014-06-03 | 2016-05-18 | 西安电子科技大学 | 关于驻留时间与重访间隔的雷达时间资源联合分配方法 |
JP6495771B2 (ja) * | 2015-07-10 | 2019-04-03 | 株式会社東芝 | 気象レーダ装置、並びに、気象レーダ装置の制御装置、制御方法、及び制御プログラム |
CN106842184B (zh) * | 2015-12-03 | 2019-12-17 | 中国航空工业集团公司雷华电子技术研究所 | 一种基于波束调度的多目标探测与跟踪方法 |
-
2018
- 2018-02-07 CN CN201810120330.2A patent/CN108490429B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101770024A (zh) * | 2010-01-25 | 2010-07-07 | 上海交通大学 | 多目标跟踪方法 |
CN106226751A (zh) * | 2016-07-08 | 2016-12-14 | 西安电子科技大学 | 基于dp‑tbd的机动目标检测与跟踪方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021138220A1 (en) * | 2019-12-30 | 2021-07-08 | Lyft, Inc. | Systems and methods for adaptive gating in initialization of radar tracking |
Also Published As
Publication number | Publication date |
---|---|
CN108490429A (zh) | 2018-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108303692B (zh) | 一种解多普勒模糊的多目标跟踪方法 | |
CN110503071B (zh) | 基于变分贝叶斯标签多伯努利叠加模型的多目标跟踪方法 | |
CN108490429B (zh) | Tws雷达多目标跟踪方法及系统 | |
CN112114308B (zh) | 一种扇扫雷达空时联合目标跟踪方法 | |
CN113777600A (zh) | 一种多毫米波雷达协同定位跟踪方法 | |
US20240288569A1 (en) | Method of target feature extraction and multi-target tracking based on 4d millimeter wave radar | |
CN110889862A (zh) | 一种网络传输攻击环境中多目标跟踪的组合测量方法 | |
CN114608585A (zh) | 一种移动机器人同步定位与建图方法及装置 | |
CN113466817A (zh) | 基于b样条曲线拟合的雷达目标航迹自动起始方法 | |
CN113486300A (zh) | 一种无人驾驶车辆多目标跟踪方法 | |
Blackman et al. | Integration of passive ranging with multiple hypothesis tracking (MHT) for application with angle-only measurements | |
Musicki et al. | Multi-target tracking in clutter without measurement assignment | |
CN116028775A (zh) | 一种多传感器融合方法、装置、设备及存储介质 | |
Li et al. | A ship target detection and tracking algorithm based on graph matching | |
CN108572362B (zh) | 一种tws雷达空时联合关联跟踪方法及装置 | |
JP2004219300A (ja) | 目標追尾装置 | |
CN102707278B (zh) | 奇异值分解的多目标跟踪方法 | |
CN102707279B (zh) | 序列ud分解的多目标跟踪方法 | |
CN108981707B (zh) | 基于时差量测箱粒子phd的被动跟踪多目标方法 | |
CN102426357B (zh) | 一种具有图像确认的多目标跟踪方法 | |
CN102707280B (zh) | 稳定结构的多目标跟踪方法 | |
CN102901959B (zh) | Ud分解的多目标跟踪方法 | |
JP3440010B2 (ja) | 目標追尾装置 | |
CN116879863B (zh) | 一种连续波4d毫米波雷达多目标测量方法及系统 | |
Bhatti et al. | Adaptive measurement noise covariance matrix R for JPDAF based multitarget tracking |
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 |