自适应低空机动目标角跟踪算法
- 格式:pdf
- 大小:1.26 MB
- 文档页数:5
雷达低空探测算法是用来检测和跟踪低空目标的一种技术,主要应用于军事和民用领域。
雷达低空探测面临的主要挑战是地面和低空目标的杂波干扰,以及目标与地面、建筑物之间的遮挡。
以下是一些常用的雷达低空探测算法:
1. CFAR算法:CFAR(Constant False Alarm Rate)算法是一种自适应杂波抑制算法,通过计算每个像素的杂波功率水平,调整门限电平,以保持恒定的虚警概率。
在低空探测中,CFAR算法可以有效抑制地面和低空杂波,提高目标检测概率。
2. MTI算法:MTI(Moving Target Indicator)算法是一种基于运动目标与固定杂波在多普勒频移上存在差异的算法。
通过滤波器组对回波信号进行滤波处理,去除固定杂波,保留运动目标信号。
MTI算法可以降低杂波干扰,提高运动目标检测能力。
3. DPC算法:DPC(Doppler Power Coherence)算法是一种基于多普勒频移的检测算法。
该算法通过分析多普勒频谱,检测出具有高功率谱密度的目标信号。
DPC算法对低空目标的探测具有一定的鲁棒性,能够克服地面和建筑物遮挡的影响。
4. 协同探测算法:协同探测算法是一种利用多个雷达站进行低空目标探测的算法。
该算法通过多个雷达站的信号处理和信息融合,提高低空目标的检测概率和定位精度。
协同探测算法可以降低单个雷达站面临的杂波干扰和遮挡问题。
这些算法各有特点,可以根据具体应用场景选择适合的算法进行低空目标探测。
同时,还需要注意雷达系统的参数设置,如波束宽
度、脉冲宽度、采样率等,以获得更好的低空探测性能。
一种空中目标航迹的自适应跟踪算法贺成龙;秦洪;于永生【摘要】采用最小二乘法估计速度和加速度,通过引入机动检测,动态调整有限记忆的点数,在速度估计上,既保证直飞段的平稳,又减小转弯段的滞后,从而实现空中目标航迹自适应跟踪.对位置采用一步滤波估计,在位置滤波上,提出一种由状态信息进行滚转角预测的方法,并将滚转角引入到卡尔曼滤波参数的自适应修正上.仿真结果表明,采用该方法既能使直飞段很好地维持航迹平稳,又能在转弯段实现目标的快速跟踪.【期刊名称】《深圳大学学报(理工版)》【年(卷),期】2014(031)004【总页数】6页(P361-366)【关键词】信号与信息处理;空中目标;目标跟踪;自适应跟踪;机动检测;滚转角预测;卡尔曼滤波【作者】贺成龙;秦洪;于永生【作者单位】信息系统工程重点实验室,南京210007;信息系统工程重点实验室,南京210007;信息系统工程重点实验室,南京210007【正文语种】中文【中图分类】TP391雷达目标的滤波跟踪算法以目标运动模型为前提,既要保证目标直飞时的航迹平滑,又要实现机动转弯时的快速跟踪.然而,理论运动模型与实际运动模型之间常存在较大差别[1-3],雷达观测数据亦有测量误差,所以,如何由观测数据估计理论模型的未知参数,以期更好地解决模型与实际系统的精确匹配,是一个值得深入研究的问题.此外,目标的运动状态是时变的,如何校正滤波器增益,达到自适应滤波[4-7],实现机动目标的平滑快速准确跟踪也是一个研究难点.为改进传统机动目标跟踪方法,本研究提出基于动态有限记忆预测的自适应卡尔曼滤波算法,其速度和加速度的估计采用动态有限记忆测量点的预测,位置则采用一步滤波估计.采用此方式,速度和加速度的估计更贴近工程现实,减小了雷达随机测量误差的波动对速度的估计和影响,而在位置滤波环节,卡尔曼滤波算法的输入扰动与观测噪声则根据目标的运动状态,以及雷达性能参数等进行实时修正,从而达到机动目标的自适应跟踪.这样既能很好地保持直飞时的航迹平滑,又能实现机动转弯时的快速跟踪.1 自适应跟踪策略目标运动可看作一个多维时变系统,采用经典卡尔曼滤波方式对目标进行跟踪,其k时刻的离散变量的运动状态方程为其中,x为n维状态变量;A为n×n阶增益矩阵;B为n×l阶控制输入u的增益矩阵;随机信号w为过程噪声矩阵,表示u的不确定性A将上一时刻k-1的状态线性映射到当前时刻k的状态,B为k-1时刻输入映射,B-1w可视为输入的不确定性.定义m维观测变量z,得量测方程其中,H为状态变量到观测值的增益,是一个m×n阶矩阵;随机信号v为观测噪声矩阵,表示z的不确定性.假设w和v相互独立,其正态分布的白噪声分别为其中,Q为输入噪声的协方差;R为观测噪声的协方差.图1 雷达目标自适应跟踪框架Fig.1 Adaptive tracking framework of target采用卡尔曼滤波的基本方程为其中,下标k表示第k时刻;k-1表示前一时刻;Pk是k时刻的协方差矩阵;为状态x 的最优估计量;Ⅰ是单位阵;Kk为k时刻的卡尔曼增益.此问题中,P的初值选取并不重要,经迭代后将会收敛,Pk,k-1是P由k-1时刻转换到k时刻的中间变量.实时雷达目标跟踪时,采用卡尔曼滤波的难点在于:①目标状态信息的确定.由于雷达一般不能提供速度信息,目标速度和加速度需根据位置信息通过二次计算得到,而雷达随机测量误差又导致位置信息波动较大,严重影响速度和加速度的估计质量;②噪声的确定.观测噪声v不仅与雷达探测精度有关,且与目标到雷达站的距离有关,输入不确定性w直接反映了输入预测u的准确度,与目标的运动状态有较大关系,目标做机动转弯时,u明显滞后,w将大增.为此,本研究提出一种自适应的卡尔曼滤波跟踪算法,用目标的有限记忆测量点来预测目标运动的状态信息,并采用一步滤波计算位置.根据最新测量信息和雷达性能参数修正R,并将修正后的R值引入机动检测环节,用以判定目标运动状态,实现动态调整速度和加速度的估计策略;同时,根据目标机动状态实时修正Q值,达到快速跟踪目标的目的.算法框架如图1.其中,自适应处理策略包括:①通过机动检测,判定目标运动的机动状态,动态估计速度和加速度,保证直飞段目标速度和加速度估计平滑,转弯段目标速度和加速度更贴近当前真实值,减小滞后;② 根据机动检测估计目标转弯坡度,引入滚转角反馈来实时调整Q,实现转弯的快速跟踪.2 动态有限记忆的速度与加速度估计为避免因雷达随机测量误差的波动导致速度和航向估计变化过大,通常采用有限记忆的5~7点来进行平滑计算,而非仅选用最近2点.另外,点数的选取上还需考虑目标的运动状态,若目标处于转弯机动时,选取点数应相应减少,贴近目标当前机动状态,减小了速度与加速度估计的滞后.为便于速度估计,假定目标作匀速直线运动,真实航迹用一阶多项式表示,即其中,x为t时刻的位移;x0为初始位置;Vx为目标在x处的移动速度;t为时间,可用最小二乘法求解[8].位置方程为这里,n为点数;在估计速度时,默认目标在当前有限记忆的几个周期里是匀速运动的,最小二乘估计的速度被认为是目标当前的最新速度,则平均加速度可通过计算最近两次的速度变化率得到,即在探测目标的过程中,信息获取的时间间隔T通常是相同的,设出现第1次信息的时间为0,即t1=0,则t2=T,t3=2T,ti=(i-1)T,tn=(n-1)T.把ti=(i-1)T代入式(13)和式(14),得其中,预测速度的方差为其中,σ2xi为x轴坐标的测量精度.那么x轴方向上的加速度估计方差为同理,可得y轴方向的加速度估计方差为从方差的取值可见,速度和加速度的计算精度与坐标测量精度σx成正比,与测量次数n相关,n越大,ηV就越小,速度与加速度的估计方差越小,即精度越高,但是n取值越大,涉及历史测量信息越多,估计越滞后,直飞影响较小,当目标处于高机动时,反而会导致估计偏差较大.因此,有必要引入机动检测环节,若检测到目标正在进行机动,则适当减小有限记忆点数.3 机动检测机动目标跟踪时,判定目标是否进行机动是非常关键的,工程上多采用状态门限判定的方法[9-10].本研究提出一种滚转角预测的方法,通过利用目标速度与加速度的向量关系,以及飞机协调转弯的特性,近似地求解目标的滚转角度.由飞行力学可知,现代飞机通过滚转实现转弯.飞机协调转弯时的受力分析见图2[11].其中,L为升力;G为重力;φ为滚转角.飞机左滚则左转,右滚则右转,滚转角越大,转弯机动越强烈.图2 飞机转弯受力分析Fig.2 Stress analysis when aircraft turning协调转弯时,在垂直方向上升力的分力与重力平衡,保持飞机在水平面内飞行,升力的水平分力提供了转弯的向心力F[11],飞机以恒定的转弯角速度在水平面内作圆周运动,则有其中,m为飞机质量;g为重力加速度;V为速度的大小.通过联立式(23)和式(24),可得定义向量 a=[ax,ay],V=[Vx,Vy],可得加速度与速度的夹角余弦,为将加速度分解到与速度垂直的方向,可近似求得向心力大小为将式(23)和式(24)代入式(27),得解得滚转角为综上可见,飞机的滚转角度仅与速度和加速度相关,通过计算,可近似得到目标转弯时的滚转角度,滚转角越大,表明转弯越剧烈.判定当前目标是否处于机动,可预设滚转角门限,滚转角若超过该门限值,即认为目标处于机动状态.4 滤波参数设计设置目标的状态向量x=[x,˙x,y,˙y]T,观测向量z=[x,y]T,输入u=[ax,ay]T,雷达采样周期为T,状态方程各参数可描述为滤波参数的选取直接影响位置滤波的效果,观测噪声R主要是由于雷达观测的随机误差造成,可由目标与雷达的距离,以及雷达测量精度确定,而过程激励噪声Q,通常是难以确定的,其值是输入不确定性高低的一个反映.4.1 噪声协方差矩阵的确定在目标跟踪问题中,采用直角坐标系的优点在于滤波和外推过程可在线性动态模型上实现.而雷达测量是在极坐标系中完成的,因此采用直角坐标系不可避免地存在量测误差的耦合,考虑二维坐标,测量距离为ρ,方位角为θ,跟踪在X-Y直角坐标系中完成,量测形式为量测的噪声协方差矩阵为其中,这里,和σ2θ分别表示距离和方位角量测方差,当θ不为nπ/2时,σ2xy≠0,表明量测存在耦合.从卡尔曼滤波方程可知,R越小,测量变量zk的权重越来越大,而zk的预测Qxk的权重越来越小.4.2 输入扰动不确定性的计算Q表示输入扰动的不确定性,通常难以被确定的[12],若输入为加速度,则Q 的表达式与加速度估计方差相关,即其中,加速度估计方差的取值见式(21)和式(22).目标转弯机动时,加速度估计有明显滞后,且不准确程度明显加大,式(39)并未反映此情况,因此需将滚转角反馈引入Q的计算,如图3.新的加速度估计方差σ2anew由原加速度方差σ2a和滚转角修正量组成,当目标滚转机动时,通过引入滚转角反馈增加目标的输入不确定性,反馈增益Kφ的大小代表滚转角对加速度估计不确定性的影响程度,其取值可通过先尝试选取,再进行仿真验证.图3 引入滚转角反馈的加速度方差计算示意图Fig.3 Variance calculation after introduced roll angle acceleration feedbackQ的增加,实际上使先验估计误差协方差Pk增大,测量变量zk的权重增加.zk的预测Hxk的权重减小,有助于转弯段的快速跟踪.5 仿真结果以某雷达探测点迹数据进行仿真验证,分别取直飞段和转弯段的两段航迹如图4和图5.图4为直飞段仿真航迹,图中两处标注的虚线框区域,较好地表现出滤波航迹有效地抑制了观测噪声,较平稳地按预测的方向飞行.图5中将本研究算法与常规调节滤波参数、交互式多模型 (interacting multiple model,IMM)航迹滤波跟踪方法进行航迹跟踪对比,虚线框标注了目标转弯的快速跟踪,算法能有效检测到转弯,进行快速跟踪,最大转弯偏差为约1 km,IMM交互多模型滤波跟踪,最大转弯偏差约为1.3 km,常规调节滤波参数方法最大转弯偏差约为2.2 km.图4 直飞段雷达航迹与滤波航迹Fig.4 (Color online)Radar measured trackand filtered track in straight flight图5 转弯段雷达航迹与滤波航迹Fig.5 (Color online)Radar measured trackand filtered track in turning flight本算法通过滚转角预测,能较好地识别转弯机动,同时采用增益反馈参数调节滤波跟踪参数,对Q的补偿量随滚转角渐进变化,连续性较佳,且航迹转弯平滑.常规调节滤波参数的航迹跟踪算法,多采用机动门限判别,弱机动检测能力差,超过门限时会重新调整滤波参数,令滤波参数变化的连续性变差,使航迹容易出现急转现,最大转弯偏差也要大于该算法.采用IMM交互多模型的航迹滤波整体性能与本文的自适应跟踪算法基本相当,在目标转弯时,由于本算法在动态有限记忆的速度和加速度估计环节上调整了航迹点数,减少了估计滞后,转弯半径略小于IMM交互多模型算法.结语通过引入机动检测技术,实现自适应地估计动态有限记忆的速度与加速度,该方法既保证了直飞段速度的平稳,又减小了转弯段的滞后.在位置滤波上,尝试由状态信息进行滚转角预测,并将滚转角引入到滤波参数的自适应修正上,其反馈增益的具体表达式则有待进一步研究.参考文献 /References:[1] Sinha A,Kirubarajan T,Bar-Shalom Y.Application of the Kalman-levy filter for tracking maneuvering targets[J].IEEE Transactions onAerospace and Elecrtonic Systems,2007,43(3):1099-1107.[2] Lu Zhang,van der Maaten L J P.Preserving structure in model-free tracking[C]//IEEE Transactions on Pattern Analysis and MachineIntelligence. [S.l.]:IEEE Press,2014,36(4):756-769.[3] Hu Keli,Zhang Xing,Gu Yuzhang,et al.Fusing target information from multiple views for robust visual tracking[J].IET Computer Vision,2014,8(2):86-97.[4] Hanlon P D,Maybeck P S.Multiple-model adaptive estimation using a residual correlation Kalman filter bank[J].IEEE Transactions on Aerospace and Elecrtonic Systems,2000,36(2):393-406.[5] Sanchez-Garcia A J,Rios-Figueroa H,Marin-Hernandez A,etal.Tracking and prediction of motion of segmented regions using the Kalman filter[C]//International Conference on Electronics,Communications and Computers.Cholula(Mexico):IEEE Press,2014:88-93. [6] Glass J D,Lanterman A D.MIMO radar target tracking using the probability hypothesis density filter[C] //IEEE Aerospace Conference.Big Sky(USA):IEEE Press,2012:1-8.[7] Zhao Zonggui,Xiong zhaohua,Wang Ke,et rmation fusion concepts,methods and applications[M].Beijing:National Defense Industry Press,2012. (in Chinese)赵宗贵,熊朝华,王珂,等.信息融合概念、方法与应用[M].北京:国防工业出版社,2012.[8] Wang Z,Ching P C.Constrained least squares estimation for position tracking[C]//IEEE International Conference on Acoustics,Speech and Signal Processing.Toulouse(France):IEEE Press,2006,4:517-520.[9] Holzinger M,Scheeres D.Object correlation and maneuver detection using optimal control performance Metrics[C]//Proceedings of the Advanced Maui Optical and Space Surveillance Technologies Conference.Maui(USA):The Maui Economic Development Board,2010:E26. [10] Maskell S.Tracking maneuvering targets and classification of their maneuverability[J].EURASIP Journal on Advances in Signal Processing,2004,15:2339-2350.[11] Wu Sentang.Flight control system [M].Beijing:Beijing University of Aeronautics and Astronautics Press,2005.(in Chinese)吴森堂.飞行控制系统[M].北京:北京航空航天大学出版社,2005.[12] Zhou K,Wang X Q,Tomizuka M,et al.A new maneuvering target tracking algorithm with input estimation[C]//Proceedings of American Control Conference.Anchorage(USA):IEEE Press,2002,1:166-171.。
文章编号:1671-637Ⅹ(2008)0920021204机动目标跟踪的新算法郭 龙, 刘洁瑜(第二炮兵工程学院,西安 710025)摘 要: 机动目标通常不是做恒定的运动,其运动状态会随时间的变化而变化。
这就使描述系统运动的状态方程是非线性的,而且系统参数会不断变化。
传统的推广卡尔曼滤波适用于定系统定参数的情况,如果运用到机动目标跟踪上会导致误差增大甚至滤波发散。
基于此,将强跟踪滤波运用到机动目标跟踪上。
强跟踪滤波在卡尔曼滤波的基础上引入了多重渐消因子,使强跟踪滤波具有极强的跟踪能力和较好地鲁棒性,因此可以很好地解决变系统变参数的问题。
通过仿真,将强跟踪滤波与UT2BLUE滤波方法和EKF滤波方法进行比较,结果表明了该滤波方法的有效性和优越性。
关 键 词: 强跟踪滤波; 卡尔曼滤波; 目标跟踪; 机动目标中图分类号: V271.4; TN911.2 文献标识码: AAnewalgorithmformaneuveringtargettrackingGUOLong, LIUJie2yu(The Second Artillery EngineeringCollege,Xi’an710025,China)Abstract: Themaneuveringtargetusuallychangesitsmotionstatedynamicallywiththetime.Thustheequations describingthemovingstatearenonlinearandtheparametersvaryconstantly.TraditionalExtendedKalmanFilter(EKF)issuitableforconstantparametersystem,itwillcausegreatererrororevenfilteringdivergenceifitisappliedinmaneuveringtargettracking.Therefore,itisproposedtouseStrongTrackingFilter(STF)inmaneuveringtargettracking.STFaddsmulti2fadingfactorsinEKF,thusithasstrongtracking capabilityandgood robustness,andcandealwithvariationparametersystemeffectively.Simulationwascarried outtocompareSTFwithUT2BLUEandEKF,theresultsindicatedthatthenewfilterismoreeffective.Keywords: STF; extendedKalmanfilter; targettracking; maneuveringtarget0 引言目标跟踪应用中,混合坐标系统下的跟踪滤波是流行的方法之一。
0引言在现代战争中,大量的空中机动目标出现在战场,并且以其高机动性、高灵活性、全天候作战和有效的攻击火力,承担着越来越重要的作用,使战争由平面发展到立体空间,对战略战术和军队组成等产生了重大影响。
但是,随着地面雷达和低空导弹的日益完善以及反空火力的增强,空中机动目标在作战中的危险性不断增加。
由于雷达对低空目标的快速反应能力很差、波束宽等原因,基于雷达体制收稿日期:2017-05-01修回日期:2017-06-23基金项目:国家自然科学基金资助项目(61201391)作者简介:鲁鹏威(1992-),男,江苏泰州人,在读硕士。
研究方向:角度跟踪和轨迹预测。
*摘要:在现代战争中,空中目标的低空作战方式严重威胁了地面的作战单位。
针对轻型防空武器系统,提出了一种基于角度的跟踪算法,对低空机动目标的飞行特性进行分析,采用“当前”统计模型,利用扩展卡尔曼滤波理论,同时通过最小均方算法对机动频率进行自适应调整,实现了对目标的角跟踪和预测。
仿真结果表明,与固定机动频率的角跟踪算法相比,该角跟踪算法具有更好的跟踪性能,误差明显减小,并且该算法具有计算速度快、稳定性好等特点。
关键词:角跟踪,“当前”统计模型,自适应滤波,最小均方算法中图分类号:TN953+.5;TJ0文献标识码:ADOI :10.3969/j.issn.1002-0640.2018.06.006引用格式:鲁鹏威,贾方秀,王晓鸣,等.自适应低空机动目标角跟踪算法研究[J ].火力与指挥控制,2018,43(6):32-36.自适应低空机动目标角跟踪算法*鲁鹏威1,贾方秀1,王晓鸣1,刘铭2(1.南京理工大学智能弹药技术国防重点学科实验室,南京210094;2.西安交通大学人居环境与建筑工程学院,西安710049)文章编号:1002-0640(2018)06-0032-05Vol.43,No.6Jun ,2018火力与指挥控制Fire Control &Command Control 第43卷第6期2018年6月Adaptive Angle Tracking Algorithm for Low Altitude Maneuvering TargetLU Peng-wei 1,JIA Fang-xiu 1,WANG Xiao-ming 1,LIU Ming 2(1.Ministerial Key Laboratory of Intelligent Ammunition ,Nanjing University of Science and Technology ,Nanjing 210094,China ;2.Human Settlements and Architectural Engineering ,Xi'an Jiao Tong University ,Xi ’an 710049,China )Abstract :In the modern war ,the low-level mode of operations of the maneuvering target seriouslythreatens the combat units on the ground.For the light air defense weapon system ,this paper proposes a tracking algorithm based on the angle.The flight characteristics of the maneuvering target are analyzed.The "current"statistical model and the extended Calman filter are used to realize the angle tracking and prediction ,and adjust the maneuvering frequency adaptively by the least mean square algorithm.The simulation results show that compared with the fixed maneuvering frequency angle tracking algorithm ,the angle tracking algorithm has better tracking performance and less error ,and thealgorithm has the advantages of fast computation speed and good stability.Key words :angle tracking ,“current ”statistical model ,adaptive filtering ,least mean square Citation format :LU P W ,JIA F X ,WANG X M ,et al.Adaptive angle tracking algorithm for low altitude maneuvering target [J ].Fire Control &Command Control ,2018,43(6):32-36.32··(总第43-)的防空系统将无法完成对低空、超低空目标的探测与跟踪[1]。
依靠地形地物的遮蔽和地面杂波的干扰,在低空飞行的目标不易被发现,所以低空和超低空突防成为空中单位的主要作战方式。
目前,在轻型防空武器系统超低空防空领域,仅有角测量的条件下,国内外学者提出了大量角跟踪算法。
王勇等人[2]提出了“当前”统计模型下的扩展卡尔曼角跟踪算法,实现了目标的角跟踪,但是跟踪精度不高;Al-Emadi等人[3]提出了一种利用同步信号参考与振荡信号的角度跟踪技术的测量转换器,表现出优异的跟踪性能,但是所利用的系统较为复杂;任波等人[4]提出了非线性预测滤波算法,在选取恰当的加权矩阵条件下,可以实现有效的跟踪,但是,加权矩阵很难解析求到,主要根据经验给定,不能保证最优结果。
本文针对轻型防低空武器系统,以低空机动目标为研究对象,分析其飞行轨迹,提出了一种基于角度的自适应跟踪算法,通过仿真证明了该算法的有效性和优越性,并且可以在简单的系统中实现。
1算法设计空中作战单位在低空或者超低空飞行时,一般采用地形跟随飞行方式,利用地物作掩护,在贴近地面的高度上隐蔽接近攻击目标[5]。
低空机动目标的飞行特性主要分为机动飞行和非机动飞行。
非机动飞行主要表现为巡航飞行;机动飞行包括以下的飞行方式:悬停跳跃、平飞加速、定常爬升、定常转弯、减速转弯、蛇形飞行和高速拉起等。
本文设计的低空机动目标自适应角跟踪算法的基本思路如图1所示。
首先根据低空机动目标的飞行特性,建立合适的模型;然后根据建立的模型对滤波进行初始化设计;在初始化设计后,进行扩展卡尔曼滤波计算;滤波结束后进行模型的自适应修正,以提高接下来跟踪的精度;最后是滤波结果的输出。
图1算法流程图1.1建立目标模型模型的设计对估计精度有很大的影响,在该算法中,将低空机动目标看作质点,观测用的传感器在坐标原点,具体的几何关系如图2所示。
根据图2,建立如下的随机非线性系统:(1)式中,f和h都是非线性方程;w(k)是以Q(k)为协方差矩阵的系统过程噪声,v(k)是量测噪声,其协方差矩阵是R(k);x(k)是系统的状态向量,z(k)是系统的观测向量,具体关系如下:(2)(3)综合之前的低空机动目标的飞行特性,建立“当前”统计模型,连续系统模型的描述如下[6]:(4)式中,。
将“当前”统计模型离散化,得到离散形式的动力学模型如下:(5)式中:图2目标与观测量的几何关系图鲁鹏威,等:自适应低空机动目标角跟踪算法33··0963(总第43-)火力与指挥控制2018年第6期过程噪声方差Q 的表示如下:(6)式中,,,,,,。
此外,α是“当前”统计模型中的机动频率,σ2x 的计算如下(σ2y 和σ2z 的计算与之类似):(7)式中,a M 与a -M 是目标在某一方向所能达到的最大正加速度和最大负加速度,a 是目前加速度的预测值。
1.2扩展卡尔曼滤波1.2.1计算预测均值和方差根据前文建立的模型,由于系统的非线性,采用扩展卡尔曼滤波进行状态估计[7]。
首先计算飞行目标的预测均值和方差,计算公式如下:(8)(9)1.2.2计算雅克比矩阵由于观测方程h 是非线性的,所以需要计算h 在处的雅克比矩阵,计算如下:(10)式中,x 、y 、z是中预测的目标位置信息。
1.2.3计算观测预测、协方差矩阵和滤波增益观测预测的计算如下:(11)新息协方差矩阵计算如下:(12)卡尔曼滤波增益计算如下:(13)1.2.4计算后验均值和协方差矩阵后验均值计算如下:(14)协方差矩阵计算如下:(15)1.3机动频率自适应在“当前”统计模型中,机动频率α是根据跟踪目标机动程度来确定的,机动频率越小,目标的机动程度越大。
低空机动目标可以进行机动性小的巡航飞行,也能够实现机动性强的飞行,所以,在该模型中,对机动频率进行自适应调整将会提高跟踪精度。
最小均方(LMS )算法具有计算简单、易于收敛等特性,可以很好地应用在实时性要求高的跟踪算法中,所以利用LMS 算法对机动频率进行自适应调整[8]。
在LMS 算法中,它的更新方程如下:(16)式中,μ是收敛因子,e (k )是预期输出与实际输出之差,x (k )是系统的输入,为了保证算法的收敛性,μ34··0964(总第43-)应该在一定的范围内取值。
将LMS 算法应用到本文的扩展卡尔曼滤波中,将整个滤波系统看作一个网络,机动频率α就是这个网络的权值,e (k )x (k )是观测预测与实际观测之差,即,所以,可以得到机动频率α的调整公式:(17)2仿真与分析考虑低空机动目标的飞行特性,利用计算机生成飞行轨迹,仿真的轨迹特征见表1,目标的飞行轨迹见图3,图中每个点之间的时间为0.1s 。
然后计算出目标的高低角和方位角,作为理论数据,将观测误差以正态分布随机加到理论数据上,作为观测数据。
本次仿真的采样时间为0.1s ,观测方位角和高低角的误差方差为1°,方位角理论值和观测值见图4,高低角理论值和观测值见图5。
表1仿真轨迹特征图3飞行轨迹图图4方位角理论值和观测值图5高低角理论值和观测值图6方位角误差图图7高低角误差图在进行仿真时,对固定的机动频率和自适应机动频率分别进行仿真,固定的机动频率取值为0.001和0.01,自适应机动频率的初始取值与其相同,方位角的误差见图6,高低角的误差见图7,计算整个过程的平均均方根误差见下页表2。