CN104407337A - 面向转弯机动目标的数据滤波方法及系统 - Google Patents

面向转弯机动目标的数据滤波方法及系统 Download PDF

Info

Publication number
CN104407337A
CN104407337A CN201410642251.XA CN201410642251A CN104407337A CN 104407337 A CN104407337 A CN 104407337A CN 201410642251 A CN201410642251 A CN 201410642251A CN 104407337 A CN104407337 A CN 104407337A
Authority
CN
China
Prior art keywords
angular velocity
target
prime
omega
wave filter
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
CN201410642251.XA
Other languages
English (en)
Other versions
CN104407337B (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.)
709th Research Institute of CSIC
Original Assignee
709th Research Institute of CSIC
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 709th Research Institute of CSIC filed Critical 709th Research Institute of CSIC
Priority to CN201410642251.XA priority Critical patent/CN104407337B/zh
Publication of CN104407337A publication Critical patent/CN104407337A/zh
Application granted granted Critical
Publication of CN104407337B publication Critical patent/CN104407337B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/41Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/36Means for anti-jamming, e.g. ECCM, i.e. electronic counter-counter measures

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明提供一种面向转弯机动目标的数据滤波方法,其步骤如下:接收目标点迹;第一滤波器对目标点迹进行滤波;判定目标速度向量是否适合进行角速度估计;计算目标水平航向及其方差;第二滤波器对目标水平航向进行滤波;判定目标角速度是否适合进行转弯判定;将目标角速度存储在角速度队列尾部;判定角速度队列长度是否大于M;判定角速度是否增加;判定角速度是否减小;计算第一滤波器增益后的过程噪声矩阵;输出目标航迹点。其优点在于:采用模糊序贯判决法判断角速度增大或减小,当判为机动时根据角速度变化大小计算过程噪声增益,提高了扩展卡尔曼滤波器对目标转弯机动的敏感性和稳定性,特别适用于飞机起飞或降落时的目标跟踪。

Description

面向转弯机动目标的数据滤波方法及系统
技术领域
本发明涉及一种雷达数据滤波方法领域,特别涉及一种面向转弯机动目标的数据滤波方法及系统。
背景技术
在目标跟踪中,雷达一般通过数据录取器将目标信号解算为目标的距离、方位、仰角等观测值,这些观测值又称为点迹。然后,使用数据处理器对点迹进行处理,最大限度的提取目标位置及运动信息(如速度、角速度),这个过程称为雷达数据处理。雷达数据处理一般包括建航、航迹数据关联、数据滤波等环节。
其中,数据滤波可以降低点迹数据的随机噪声,提高目标跟踪的精度,得到更好的目标航速航向,使机动目标的跟踪更加稳定。由于雷达接收机必须对一定范围内的频率都非常敏感,因此会接收一定水平的背景噪声,这个噪声是一个随机过程。在脉冲累积中,噪声可能引起录取点迹的随机错误,同时在信号处理的过程中可能引入热噪声,造成雷达探测到的目标位置包含随机误差。这种误差特性可以通过雷达鉴定试验确定,比较容易建立量测模型,使用卡尔曼滤波器可以有效滤除部分随机噪声。
在机动目标跟踪过程中,滤波器需要自适应地调整参数,稳定输出航速航向。如在飞机起飞或降落的过程中,飞机的两种主要运动状态是匀速降落或爬升、匀速转弯,由于飞机转弯机动及雷达跟踪性能下降,常常造成数据特性突变,这会引起窄带滤波器的滞后或发散,而宽带滤波器输出的航速航向不稳定。转弯机动目标的数据滤波涉及到飞机转弯角速度估计、转弯机动检测、带宽自适应等多个方面的难题。
目前,目标机动跟踪滤波的方法很多,早期多采用基于传统的残差矩阵假设检验方法、建立相关有色噪声模型的方法,对实际目标的机动判定敏感性和准确性均不够理想。
发明内容
为解决目前的目标机动跟踪滤波的方法对实际目标的机动判定敏感性和准确性差的问题,有必要提供一种面向转弯机动目标的数据滤波方法及系统。
一种面向转弯机动目标的数据滤波方法,其包括如下步骤:
S1、第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量;
S2、判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到步骤S6;
S3、判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到步骤S4;小于预设长度时,跳转到步骤S6;
在不适合进行转弯判定时,跳转到步骤S6;
S4、判断角速度是否增加,在角速度增加时,跳转到步骤S5;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到步骤S6;在角速度减少时,跳转到步骤S5;
S5、计算第一滤波器增益后的过程噪声矩阵;
S6、输出目标航迹点。
一种面向转弯机动目标的数据滤波系统,其包括如下单元:
目标速度向量获取单元,用于通过第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量;
第一判断单元,用于判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到过程噪声矩阵计算单元;
第二判断单元,用于判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到角速度判断单元;小于预设长度时,跳转到角速度判断单元;
在不适合进行转弯判定时,跳转到过程噪声矩阵计算单元;
角速度判断单元,用于判断角速度是否增加,在角速度增加时,跳转到步骤角速度判断单元;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到过程噪声矩阵计算单元;在角速度减少时,跳转到角速度判断单元;
过程噪声矩阵计算单元,用于计算第一滤波器增益后的过程噪声矩阵;
输出单元,用于输出目标航迹点。
本发明提供的面向转弯机动目标的数据滤波方法及系统,通过采用角速度估计方法、转弯机动判决方法及机动水平自适应的过程噪声增益方法共同组成针对空中转弯目标的数据滤波方法。具体而言,本发明适合于雷达数据处理设备升级改造;判断角速度增大或减小,当判为机动时根据角速度变化大小计算过程噪声增益,提高了对目标转弯机动的敏感性和稳定性,特别适用于飞机起飞或降落时的目标跟踪;本发明适用广泛,适用于各种二/三维对空雷达,特别是二次航管雷达。
附图说明
图1是本发明实施方式提供的面向转弯机动目标的数据滤波方法流程图;
图2是本发明实施方式提供的面向转弯机动目标的数据滤波系统的结构框图。
具体实施方式
如图1所示,本发明实施例提供一种面向转弯机动目标的数据滤波方法,其包括如下步骤:
S1、第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量。
可选地,步骤S1包括以下步骤:
数据处理设备收到t时刻目标点迹Zt,并将t时刻目标点迹Zt发送给第一滤波器,第一滤波器为匀速直线运动模型扩展卡尔曼滤波器;
第一滤波器对目标点迹进行滤波,得到滤波后的t时刻目标航迹点,记该目标航迹点的目标速度向量为Vt,目标速度向量的维数为N,N等于2或者3,那么Vt=(vi,t)i=1...N,其中v1,t为水平正东方向的速度分量,v2,t为水平正北方向的速度分量,v3,t为垂直水平面向天顶方向的速度分量,记速度分量vi,t对应的方差为σi,t 2
S2、判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到步骤S6。
第二滤波器可选为卡尔曼滤波器。
可选地,步骤S2包括以下步骤:
计算目标速度的非零检测量判断dt是否大于N;如果dt小于N,跳转到步骤S6;如果dt大于N,则判定为适合进行角速度滤波;
计算目标水平航向目标水平航向单位为弧度,象限取[-π,π),目标水平航向的方差为
将目标水平航向和目标水平航向的方差输入到第二滤波器,第二滤波器为卡尔曼滤波器,状态向量由目标水平航向b(t)、目标角速度ω(t)组成,记为(b(t),ω(t)),状态方程为观测向量由b(t)单独组成;
通过第二滤波器对目标水平航向进行滤波,计算出目标角速度,记为ωt,单位为弧度每秒,象限取[-π,π);并计算出角速度方差,记为σω,t 2
S3、判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到步骤S4;小于预设长度时,跳转到步骤S6;
在不适合进行转弯判定时,跳转到步骤S6。
可选地,步骤S3包括以下步骤:
计算目标角速度的非零检测量为dω,t=|ωtω,t|,如果dω,t≤1,则判定为不适合进行转弯判定,并跳转到步骤S6;如果dω,t>1,则判定为适合进行转弯判定;将目标角速度存储在角速度队列尾部;将目标角速度存储在角速度队列尾部具体包括:角速度队列为先进先出队列,新加入的目标角速度存储在队列尾部,加入后队列长度增加1;
记角速度队列的预设最大长度为M,M是大于3的正整数,角速度队列长度大于M跳转到步骤S4;角速度队列长度小于M时,跳转到步骤S5。
S4、判断角速度是否增加,在角速度增加时,跳转到步骤S5;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到步骤S6;在角速度减少时,跳转到步骤S5。
可选地,步骤S4包括以下步骤:
判断角速度是否增加,具体包括如下:删除角速度队列头部的值,标记队列中的角速度值从头到尾依次为ω1、ω2…ωM,统计ωM>ωM-1、ωM-1>ωM-2…ω2>ω1中成立的不等式个数为M1,记角速度变化值为Δω,计算Δω=|ωM1|,判断且Δω>0.02是否成立,在且Δω>0.02成立时跳转到步骤S5;
且Δω>0.02不成立时,统计ωM<ωM-1、ωM-1<ωM-2…ω2<ω1中成立的不等式个数为M2,计算Δω=|ωM1|,判断且Δω>0.02是否成立,在且Δω>0.02成立时,跳转到步骤S5,否则跳转到步骤S6。
S5、计算第一滤波器增益后的过程噪声矩阵。
可选地,步骤S5包括以下步骤:
在步骤S1中第一滤波器完成滤波后,其过程噪声矩阵为Q,记增益系数为c,按以下面公式计算c值: c = 2 , &Delta;&omega; < 0.04 10 , 0.04 &le; &Delta;&omega; < 0.08 100 , &Delta;&omega; &GreaterEqual; 0.08
按增益系数放大过程噪声矩阵Q′=cQ,使用Q′作为第一滤波器下次滤波的过程噪声矩阵。
S6、输出目标航迹点。
可选地,步骤S6中输出目标航迹点包括数据处理设备输出t时刻目标位置、航速和航向。
本发明提供的面向转弯机动目标的数据滤波方法及系统,依据卡尔曼滤波器的原理,采用角速度估计方法、转弯机动判决方法及机动水平自适应的过程噪声增益方法共同组成针对空中转弯目标的数据滤波方法。具体而言,本发明实施例具有以下优点:
采用匀速直线运动模型扩展卡尔曼滤波器作为基础滤波器,适合于雷达数据处理设备升级改造;
采用模糊序贯判决法判断角速度增大或减小,当判为机动时根据角速度变化大小计算过程噪声增益,提高了扩展卡尔曼滤波器对目标转弯机动的敏感性和稳定性,特别适用于飞机起飞或降落时的目标跟踪;
适用广泛,适用于各种二/三维对空雷达,特别是二次航管雷达。
可选地,所述步骤S2中第二滤波器对目标水平航向进行滤波包括如下步骤:
S21、接收目标水平航向及其方差:第二滤波器收到步骤S2中获得目标水平航向以及目标水平航向的方差的计算结果,即收到t时刻目标水平航向bt及其方差σb,t 2
S22、判定第二滤波器是否初始化:第二滤波器当前已处理的数据个数记为nb,t,如果nb,t>0,则第二滤波器已初始化,跳转到步骤S24;否则第二滤波器未初始化,跳转到步骤S23。
S23、初始化第二滤波器:第二滤波器的状态向量赋值为(bt,0),方差矩阵赋值为 &sigma; b , t 2 0 0 &pi; 2 4 , 第二滤波器过程噪声矩阵设置为 q c , t 0 0 q c , t , qc,t=10-6,第二滤波器时刻赋值为t,已处理的数据个数赋值为1,跳转到步骤S26。
S24、第二滤波器一步预测:记当前第二滤波器时刻为t′,状态向量为(bt′,ωt′),方差矩阵为 &sigma; b , t &prime; 2 cov b , &omega; , t &prime; cov &omega; , b , t &prime; &sigma; &omega; , t &prime; 2 , 计算状态向量的t时刻预测值为(bt′,ωt′)=(bt′+ωt′(t-t′),ωt′),将其中的bt′化到象限[-π,π),方差矩阵的t时刻预测值为 &sigma; b , t &prime; 2 cov b , &omega; , t &prime; cov &omega; , b , t &prime; &sigma; &omega; , t &prime; 2 = ( &sigma; b , t &prime; 2 + cov b , &omega; , t &prime; ( t - t &prime; ) + cov &omega; , b , t &prime; ( t - t &prime; ) + q c , t ( t - t &prime; ) 4 / 4 cov b , &omega; , t &prime; + &sigma; &omega; , t &prime; 2 ( t - t &prime; ) + q c , t ( t - t &prime; ) 3 / 2 ) cov &omega; , b , t &prime; + &sigma; &omega; , t &prime; 2 ( t - t &prime; ) + q c , t ( t - t &prime; ) 3 / 2 .
S25、第二滤波器修正:计算航向修正系数计算角速度修正系数计算状态向量修正值为(bt″,ωt)=(bt′+(bt-bt′)rb,tt′+(bt-bt′)rω,t),计算方差矩阵为 &sigma; b , t &Prime; 2 cov b , &omega; , t cov &omega; , b , t &sigma; &omega; , t 2 = ( &sigma; b , t &prime; 2 ( 1 - r b , t ) 2 + r b , t 2 &sigma; b , t 2 ( 1 - r b , t ) ( cov b , &omega; , t &prime; - &sigma; b , t &prime; 2 r &omega; , t ) + r b , t r &omega; , t &sigma; b , t 2 ) ( 1 - r b , t ) ( cov b , &omega; , t &prime; - &sigma; b , t &prime; 2 r &omega; , t ) + r b , t r &omega; , t &sigma; b , t 2 r &omega; , t ( r &omega; , t &sigma; &omega; , t &prime; 2 - 2 cov b , &omega; , t &prime; + r &omega; , t &sigma; b , t 2 )
第二滤波器时刻赋值为t,已处理的数据个数加1。
S26、输出目标角速度及其方差:输出t时刻的目标角速度ωt及其方差σω,t 2,跳转到步骤S3。
可选地,在上述任一项所述的面向转弯机动目标的数据滤波方法实施例中,
所述步骤S6输出目标航迹点之后,第一滤波器等待目标点迹输入;当新的目标点迹输入时,跳转到步骤S1并重复执行S1至S6。
如图2所示,本发明实施例还提供一种面向转弯机动目标的数据滤波系统,其包括如下单元:
目标速度向量获取单元10,用于通过第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量;
第一判断单元20,用于判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到过程噪声矩阵计算单元50;
第二判断单元30,用于判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到角速度判断单元40;小于预设长度时,跳转到角速度判断单元40;
在不适合进行转弯判定时,跳转到过程噪声矩阵计算单元50;
角速度判断单元40,用于判断角速度是否增加,在角速度增加时,跳转到步骤角速度判断单元40;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到过程噪声矩阵计算单元50;在角速度减少时,跳转到角速度判断单元40;
过程噪声矩阵计算单元50,用于计算第一滤波器增益后的过程噪声矩阵;
输出单元60,用于输出目标航迹点。
在仿真测试的一实施例中,两坐标雷达位于坐标原点,距离探测误差(RMS)设置为50米,方位探测误差(RMS)设置为0.15度,目标以(50000米,50000米)为中心,以10000米为半径做顺时针水平圆周运动,速度从100米/秒开始,每秒增加2米/秒,直到500米/秒,保持100秒后,每秒减少2米/秒,直到100米/秒,统计300次仿真测试数据,采用本发明的面向转弯机动目标的数据滤波方法/装置处理后,目标航迹点的距离误差均值为40.41米,方位误差均值为0.12度。
以上实施例可以自由进行组合。结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机储存器、内存、只读存储器、电可编程ROM、电可檫除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其他形式的存储介质中。
可以理解的是,对于本领域的普通技术人员来说,可以根据本发明的技术构思做出其它各种相应的改变与变形,而所有这些改变与变形都应属于本发明权利要求的保护范围。

Claims (10)

1.一种面向转弯机动目标的数据滤波方法,其特征在于,其包括如下步骤:
S1、第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量;
S2、判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到步骤S6;
S3、判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到步骤S4;小于预设长度时,跳转到步骤S6;
在不适合进行转弯判定时,跳转到步骤S6;
S4、判断角速度是否增加,在角速度增加时,跳转到步骤S5;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到步骤S6;在角速度减少时,跳转到步骤S5;
S5、计算第一滤波器增益后的过程噪声矩阵;
S6、输出目标航迹点。
2.如权利要求1所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S1包括以下步骤:
数据处理设备收到t时刻目标点迹Zt,并将t时刻目标点迹Zt发送给第一滤波器,第一滤波器为匀速直线运动模型扩展卡尔曼滤波器;
第一滤波器对目标点迹进行滤波,得到滤波后的t时刻目标航迹点,记该目标航迹点的目标速度向量为Vt,目标速度向量的维数为N,N等于2或者3,那么Vt=(vi,t)i=1...N,其中v1,t为水平正东方向的速度分量,v2,t为水平正北方向的速度分量,v3,t为垂直水平面向天顶方向的速度分量,记速度分量vi,t对应的方差为σi,t 2
3.如权利要求2所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S2包括以下步骤:
计算目标速度的非零检测量判断dt是否大于N;如果dt小于N,跳转到步骤S6;如果dt大于N,则判定为适合进行角速度滤波;
计算目标水平航向目标水平航向单位为弧度,象限取[-π,π),目标水平航向的方差为
将目标水平航向和目标水平航向的方差输入到第二滤波器,第二滤波器为卡尔曼滤波器,状态向量由目标水平航向b(t)、目标角速度ω(t)组成,记为(b(t),ω(t)),状态方程为观测向量由b(t)单独组成;
通过第二滤波器对目标水平航向进行滤波,计算出目标角速度,记为ωt,单位为弧度每秒,象限取[-π,π);并计算出角速度方差,记为σω,t 2
4.如权利要求3所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S3包括以下步骤:
计算目标角速度的非零检测量为dω,t=|ωtω,t|,如果dω,t≤1,则判定为不适合进行转弯判定,并跳转到步骤S6;如果dω,t>1,则判定为适合进行转弯判定;将目标角速度存储在角速度队列尾部;将目标角速度存储在角速度队列尾部具体包括:角速度队列为先进先出队列,新加入的目标角速度存储在队列尾部,加入后队列长度增加1;
记角速度队列的预设最大长度为M,M是大于3的正整数,角速度队列长度大于M跳转到步骤S4;角速度队列长度小于M时,跳转到步骤S5。
5.如权利要求4所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S4包括以下步骤:
判断角速度是否增加,具体包括如下:删除角速度队列头部的值,标记队列中的角速度值从头到尾依次为ω1、ω2…ωM,统计ωM>ωM-1、ωM-1>ωM-2…ω2>ω1中成立的不等式个数为M1,记角速度变化值为Δω,计算Δω=|ωM1|,判断且Δω>0.02是否成立,在且Δω>0.02成立时跳转到步骤S5;
且Δω>0.02不成立时,统计ωM<ωM-1、ωM-1<ωM-2…ω2<ω1中成立的不等式个数为M2,计算Δω=|ωM1|,判断且Δω>0.02是否成立,在且Δω>0.02成立时,跳转到步骤S5,否则跳转到步骤S6。
6.如权利要求5所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S5包括以下步骤:
在步骤S1中第一滤波器完成滤波后,其过程噪声矩阵为Q,记增益系数为c,按以下面公式计算c值: c = 2 , &Delta;&omega; < 0.04 10,0.04 &le; &Delta;&omega; < 0.08 100 , &Delta;&omega; &GreaterEqual; 0.08
按增益系数放大过程噪声矩阵Q′=cQ,使用Q′作为第一滤波器下次滤波的过程噪声矩阵。
7.如权利要求6所述的面向转弯机动目标的数据滤波方法,其特征在于,步骤S6中输出目标航迹点包括数据处理设备输出t时刻目标位置、航速和航向。
8.如权利要求6所述的面向转弯机动目标的数据滤波方法,其特征在于,所述步骤S2中第二滤波器对目标水平航向进行滤波包括如下步骤:
S21、接收目标水平航向及其方差:第二滤波器收到步骤S2中获得目标水平航向以及目标水平航向的方差的计算结果,即收到t时刻目标水平航向bt及其方差σb,t 2
S22、判定第二滤波器是否初始化:第二滤波器当前已处理的数据个数记为nb,t,如果nb,t>0,则第二滤波器已初始化,跳转到步骤S24;否则第二滤波器未初始化,跳转到步骤S23;
S23、初始化第二滤波器:第二滤波器的状态向量赋值为(bt,0),方差矩阵赋值为 &sigma; b , t 2 0 0 &pi; 2 4 , 第二滤波器过程噪声矩阵设置为 q c , t 0 0 q c , t , qc,t=10-6,第二滤波器时刻赋值为t,已处理的数据个数赋值为1,跳转到步骤S26;
S24、第二滤波器一步预测:记当前第二滤波器时刻为t′,状态向量为(bt′t′),方差矩阵为 &sigma; b , t &prime; 2 cov b , &omega; , t &prime; cov &omega; , b , t &prime; &sigma; &omega; , t &prime; , 计算状态向量的t时刻预测值为(b′t,ω′t)=(bt′t′(t-t′),ωt′),将其中的b′t化到象限[-π,π),方差矩阵的t时刻预测值为 &sigma; b , t &prime; 2 cov b , &omega; , t &prime; cov &omega; , b , t &prime; &sigma; &omega; , t &prime; 2 = &sigma; b , t &prime; 2 + cov b , &omega; , t &prime; ( t - t &prime; ) + cov &omega; , b , t &prime; ( t - t &prime; ) + q c , t ( t - t &prime; ) 4 / 4 cov b , &omega; , t &prime; + &sigma; &omega; , t &prime; 2 ( t - t &prime; ) + q c , t ( t - t &prime; ) 3 / 2 cov &omega; , b , t &prime; + &sigma; &omega; , t &prime; 2 ( t - t &prime; ) + q c , t ( t - t &prime; ) 3 / 2 &sigma; &omega; , t &prime; 2 + q c , t ( t - t &prime; ) 2 ;
S25、第二滤波器修正:计算航向修正系数计算角速度修正系数计算状态向量修正值为(b″tt)=(b′t+(bt-b′t)rb,t,ω′t+(bt-b′t)rω,t),计算方差矩阵为 &sigma; b , t &prime; &prime; 2 cov b , &omega; , t cov &omega; , b , t &sigma; &omega; , t 2 = &sigma; b , t &prime; 2 ( 1 - r b , t ) 2 + r b , t 2 &sigma; b , t 2 ( 1 - r b , t ) ( cov b , &omega; , t &prime; - &sigma; b , t &prime; 2 r &omega; , t ) + r b , t r &omega; , t &sigma; b , t 2 ( 1 - r b , t ) ( cov b , &omega; , t &prime; - &sigma; b , t &prime; 2 r &omega; , t ) + r b , t r &omega; , t &sigma; b , t 2 r &omega; , t ( r &omega; , t &sigma; &omega; , t &prime; 2 - 2 co v b , &omega; , t &prime; + r &omega; , t &sigma; b , t 2 ) ,
第二滤波器时刻赋值为t,已处理的数据个数加1;
S26、输出目标角速度及其方差:输出t时刻的目标角速度ωt及其方差σω,t 2,跳转到步骤S3。
9.如权利要求1至8任一项所述的面向转弯机动目标的数据滤波方法,其特征在于,
所述步骤S6输出目标航迹点之后,第一滤波器等待目标点迹输入;当新的目标点迹输入时,跳转到步骤S1并重复执行S1至S6。
10.一种面向转弯机动目标的数据滤波系统,其特征在于,其包括如下单元:
目标速度向量获取单元,用于通过第一滤波器接收数据处理设备收到当前时刻的目标点迹,第一滤波器对目标点迹进行滤波得到滤波后当前时刻的目标航迹点,并获得目标航迹点的目标速度向量;
第一判断单元,用于判断目标速度向量是否适合进行角速度滤波估计,在适合进行角速度滤波时,获得目标水平航向以及目标水平航向的方差,并通过第二滤波器对目标水平航向进行滤波;在不适合进行角速度滤波时,跳转到过程噪声矩阵计算单元;
第二判断单元,用于判断目标角速度是否合适进行转弯判定,
在适合进行转弯判定时,将目标角速度存储在角速度队列尾部,判断角速度队列长度是否大于预设最大长度,在大于预设长度时跳转到角速度判断单元;小于预设长度时,跳转到角速度判断单元;
在不适合进行转弯判定时,跳转到过程噪声矩阵计算单元;
角速度判断单元,用于判断角速度是否增加,在角速度增加时,跳转到步骤角速度判断单元;在角速度未增加时,继续判断角速度是否减少,在角速度未减少时,跳转到过程噪声矩阵计算单元;在角速度减少时,跳转到角速度判断单元;
过程噪声矩阵计算单元,用于计算第一滤波器增益后的过程噪声矩阵;
输出单元,用于输出目标航迹点。
CN201410642251.XA 2014-11-14 2014-11-14 面向转弯机动目标的数据滤波方法及系统 Active CN104407337B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410642251.XA CN104407337B (zh) 2014-11-14 2014-11-14 面向转弯机动目标的数据滤波方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410642251.XA CN104407337B (zh) 2014-11-14 2014-11-14 面向转弯机动目标的数据滤波方法及系统

Publications (2)

Publication Number Publication Date
CN104407337A true CN104407337A (zh) 2015-03-11
CN104407337B CN104407337B (zh) 2017-03-29

Family

ID=52644982

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410642251.XA Active CN104407337B (zh) 2014-11-14 2014-11-14 面向转弯机动目标的数据滤波方法及系统

Country Status (1)

Country Link
CN (1) CN104407337B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105372653A (zh) * 2015-11-11 2016-03-02 成都能通科技有限公司 面向岸基空管雷达系统中一种高效转弯机动目标跟踪方法
CN106168943A (zh) * 2016-07-12 2016-11-30 深圳大学 一种用于跟踪转弯机动目标的方法及其系统
CN107228667A (zh) * 2017-04-23 2017-10-03 西安电子科技大学 一种融合地图信息的改进卡尔曼滤波器室内定位跟踪方法
CN109242881A (zh) * 2018-08-13 2019-01-18 上海机电工程研究所 数据的目标机动识别方法、系统及计算机可读存储介质
CN110632611A (zh) * 2019-08-30 2019-12-31 中国南方电网有限责任公司超高压输电公司贵阳局 一种固定翼无人机载激光雷达系统转弯滤波方法
CN113049004A (zh) * 2021-02-28 2021-06-29 哈尔滨工业大学 一种航磁补偿校准质量的自动评估方法及装置

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101320089A (zh) * 2007-06-05 2008-12-10 通用汽车环球科技运作公司 用于车辆动力估计的雷达、激光雷达和摄像机增强的方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101320089A (zh) * 2007-06-05 2008-12-10 通用汽车环球科技运作公司 用于车辆动力估计的雷达、激光雷达和摄像机增强的方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
孙福明等: "转弯机动目标的两层交互多模型跟踪算法", 《控制理论与应用》 *
田雨芬等: "角速度估计自适应的IMM三维目标跟踪算法", 《电光与控制》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105372653A (zh) * 2015-11-11 2016-03-02 成都能通科技有限公司 面向岸基空管雷达系统中一种高效转弯机动目标跟踪方法
CN106168943A (zh) * 2016-07-12 2016-11-30 深圳大学 一种用于跟踪转弯机动目标的方法及其系统
CN107228667A (zh) * 2017-04-23 2017-10-03 西安电子科技大学 一种融合地图信息的改进卡尔曼滤波器室内定位跟踪方法
CN107228667B (zh) * 2017-04-23 2019-11-26 西安电子科技大学 一种融合地图信息的改进卡尔曼滤波器室内定位跟踪方法
CN109242881A (zh) * 2018-08-13 2019-01-18 上海机电工程研究所 数据的目标机动识别方法、系统及计算机可读存储介质
CN109242881B (zh) * 2018-08-13 2021-06-11 上海机电工程研究所 数据的目标机动识别方法、系统及计算机可读存储介质
CN110632611A (zh) * 2019-08-30 2019-12-31 中国南方电网有限责任公司超高压输电公司贵阳局 一种固定翼无人机载激光雷达系统转弯滤波方法
CN110632611B (zh) * 2019-08-30 2021-12-14 中国南方电网有限责任公司超高压输电公司贵阳局 一种固定翼无人机载激光雷达系统转弯滤波方法
CN113049004A (zh) * 2021-02-28 2021-06-29 哈尔滨工业大学 一种航磁补偿校准质量的自动评估方法及装置

Also Published As

Publication number Publication date
CN104407337B (zh) 2017-03-29

Similar Documents

Publication Publication Date Title
CN104407337A (zh) 面向转弯机动目标的数据滤波方法及系统
US9606848B2 (en) Iterative Kalman filtering
EP3293540B1 (en) Systems and methods for pulse descriptor word generation using blind source separation
CN105738891B (zh) 一种机载数字阵列雷达对弱机动目标角度进行跟踪的方法
CN105807267A (zh) 一种mimo雷达扩展目标的检测方法
JP5770360B2 (ja) 目標のsnrにおける変動に応答する目標追跡レーダ及び方法
CN110987066A (zh) 一种实现自动矫正的海洋风速风向测量方法及系统
CN105785340A (zh) 单脉冲雷达对主瓣内目标和诱饵干扰的测角与识别方法
US8483890B2 (en) Identification of ship state tonal parameters for use in relative GPS shipboard landing systems
CN112612006B (zh) 基于深度学习的机载雷达非均匀杂波抑制方法
US20140009325A1 (en) Method for de-interleaving received radar pulses using dynamically updated weights
CN110673148A (zh) 一种主动声纳目标实时航迹解算方法
CN106707271A (zh) 一种基于数字锁相环的自适应角度跟踪方法
CN104053234A (zh) 一种基于rssi的坐标误差补偿定位系统和方法
CN105223591B (zh) 一种用于减弱远近效应的伪卫星阵列天线方向图综合计算方法
WO2018037533A1 (ja) レーダ装置
CN104180800A (zh) 基于ads-b系统航迹点的修正方法和系统
CN105589061A (zh) 一种岸基雷达的信号处理算法
CN105259542B (zh) 一种改进的雷达副瓣干扰方法
CN113189554B (zh) 雷达实测回波数据的处理方法、电子设备及存储介质
CN111998735B (zh) 传感器可任意布阵的超声波报靶方法及装置
CN111796288B (zh) 一种基于杂波频谱补偿技术的三坐标雷达动目标处理方法
Ren et al. An improved indoor positioning algorithm based on RSSI filtering
CN108120975A (zh) 基于梯形连续波的雷达测速测距方法
CN103760553B (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