(完整word版)卡尔曼滤波器的设计关于雷达跟踪系统的定位

1、（完整word版）卡尔曼滤波器的设计关于雷达跟踪系统的定位测试信号处理大作业卡尔曼滤波器的雷达跟踪应用第三组成员：指导老师：专业:2014年12月25日1.1课题研究的背景雷达目标跟踪是整个雷达系统中一个非常关键的环节。跟踪的任务是通过相关和滤波处理建立目标的运动轨迹。雷达系统根据在建立目标轨迹过程中对目标运动状态所作的估计和预测，评估船舶航行的安全态势和机动试操船的安全效果。因此，雷达跟踪环节工作性能的优劣直接影响到雷达系统的安全效能。雷达目标跟踪就逐渐成为一门专门的学科。由于雷达目标定位是雷达目标跟踪中重要环节，这个环节所涉及到的数据是滤波技术中直接影响到滤波准确性的一个很重要的因素，因此

2、雷达中的目标定位对这个雷达跟踪系统的工作性能至关重要的作用。军事雷达中目标跟踪方面主要包括对原始侦察数据的预处理、对辐射源位置的估计及对运动辐射源的跟踪川。对原始侦察数据的预处理是将测量到的原始数值做一些去偏差的处理，使得原始数据的误差对于跟踪系统最后整个的估计结果的影响降低到最小.对辐射源位置的估计是跟踪中对于目标进行估计的起始的判断,这是雷达定位的起始步骤.对运动辐射源的跟踪既是跟踪滤波的过程，这是雷达跟踪的核心内容，它的作用是对目标运动状态的估计和预测。这三个部分对于整个军用雷达系统的工作性能都有极其重要的影响。雷达跟踪需要处理的信息种类多种多样。除了目标的位置信息外，一般还要对目标运动

3、速度进行估计，个别领域中的雷达还要对目标运动姿态进行跟踪。雷达跟踪的收敛速度、滤波精度和跟踪稳定度等是评估雷达跟踪性能的重要参数。因此提高雷达跟踪的精度、收敛速度和稳定度也就一直是改善雷达跟踪性能的重点。随着科技的发展，各类目标的运动性能和材质特征有了大幅度的改善和改变，这就要求雷达跟踪能力要适应目标特性的这种变化.在不断提高雷达跟踪性能的前提下，降低雷达跟踪系统的成本也是现代雷达必须考虑的问题。特别是在民用领域中由于雷达造价不能过高,对目标跟踪进行快收敛性、高精度和高稳定性的改良在硬件上是受到一些制约的,因此雷达跟踪算法的研究就越来越引起学者们的关注。通过跟踪算法的改进来提高雷达的跟踪性能还

4、有相当大的挖掘潜力.考虑到雷达设备的造价，民用雷达的跟踪系统首要的方法就是对于雷达的跟踪算法进行开发。1.2雷达信号检测与目标跟踪在雷达对目标进行跟踪之前，首先要对目标进行检测。跟踪是针对满足了检测条件的目标进行的,因而信号检测是目标跟踪的前置环节，良好的信号检测是提高目标跟踪性能的基础。近些年来雷达信号检测理论和实践的飞速发展，为提高目标跟踪性能创造了有利的条件。同时，跟踪也可进一步完成对目标的检测，因为可以通过跟踪去除虚假目标，可以利用跟踪获得的目标动态特征改善目标的检测和识别能力.因此从本质上看,检测与跟踪是一个可以互动和融合的过程，是一个可以在整体上进行优化的问题。对海面目标观测来说,

5、海杂波是影响目标检测和跟踪性能的一种最难处理的干扰。一直以来，海杂波都是用统计模型，比如高斯分布、对数正态分布、Weibull分布、K分布模型等加以描述。基于实验的K分布模型虽被认为是比较好的海杂波模型，但在处理高分辨率雷达数据时仍遇到困难。目标检测的实质是在噪声背景中提取目标信息,因此去噪就成了目标检测的关键。度量目标检测的好坏的两个主要标准是：发现概率，虚警概率.这两个标准之间存在着矛盾,如果发现概率大，那么虚警概率也会相应增大，这是雷达检测里不可避免的.但是为了尽量提高发现概率而又不加大虚警概率，现在通行的方法是在虚警概率恒定的条件下，尽量提高发现概率。在目标检测中，通常以信噪比作为目标

6、检测的门限。交管雷达和航海雷达常用脉冲相关积累检测的方法,它将几个连续脉冲的回波进行叠加，利用噪声的不相关性或者弱相关性来剔除噪声，留下目标。这种方法有利于识别方位粘合目标,当几个连续回波做相关积累以后，在方位上就可以从粘合目标回波的包络上判别出是否是粘合目标。从而在算法上加大了雷达的方位分辨率。另外，在航海雷达中还可以用多卜勒技术进行目标检测，由于在一个海域内，海浪的速度是一致的,因此海浪相对与雷达的多卜勒频率就形成了一个比较窄的频带,可以利用窄带带陷滤波器将这个频率滤除，留下目标运动所产生的多卜勒频率，即检测到目标。但是这种方法的应用很受限制,因为当目标随浪漂或者其速度与海浪前进速度相似的

7、时候,目标的多卜勒频率同时被滤除,这样也就形成了漏警。上世纪90年代以来，S。Haykin和H。Leung等人做了大量的工作，更好地考虑了物理背景和数学模型的结合,提出了基于混沌理论的海杂波模型,认为混沌可以产生符合任何概率分布的类似随机信号,海杂波的随机特性是由确定性的低维混沌产生的。相比于传统的统计模型,这种模型可以使用相对较少的自由度来描述产生海杂波的复杂非线性动力系统,具有很好的杂波抑制能力。另外,还有一（完整word版）卡尔曼滤波器的设计关于雷达跟踪系统的定位些雷达通过极化检波来进行目标检测.在雷达极化学中引入的STOCKS极化矢量，对雷达发射波和回波的极化分析有着重要意义。由于背景

8、噪声的stocks极化状态转换矩阵与目标的stocks极化状态转换矩阵存在着比较大的参数差异，因此也可以用检测极化状态转换矩阵的方法来进行极化检波.1.3雷达目标跟踪的基本方法雷达跟踪滤波其实就是在对提取的目标信息进行估计和预测的基础上，建立目标的运动轨迹，评估航行安全态势和机动效果。目前雷达跟踪技术有多种多样的方法，在进行目标跟踪时要考虑到目标特性、可用的目标观测信息及先验知识和跟踪的性能要求等多种因素，进而选取目标的机动模型和滤波方法。1。4卡尔曼滤波的稳定性和准确性通过对卡尔曼滤波算法的研究,发现卡尔曼滤波算法对初始条件的选取比较敏感.初始值的选取直接影响到后来滤波是否收敛。卡尔曼滤波的

9、稳定性问题是滤波器能否应用的一个关键问题.由于卡尔曼滤波不但存在对系统模型的强依赖性与鲁棒性差的缺陷，而且在系统达到平稳状态时将丧失对突变状态的跟踪能力，因此该方法对机动目标的跟踪能力有限。从而丧失对突变状态的跟踪能力，就是一种很严重的算法丢跟踪状态,也是滤波不收敛的情况之一。而实际的滤波过程是否稳定即滤波器是否发散,却是表明滤波效果的问题。自从卡尔曼滤波提出以后，对于滤波的稳定性、滤波的发散以及发散的抑制等问题，己经有很多文献进行了深入的分析和研究。实际应用表明，理论上卡尔曼滤波器的稳定性并不能保证滤波算法实际的收敛，从而不能保证滤波的有效性.这主要是因为系统的动态模型和噪声的统计模型的不准

10、确造成的。滤波发散一般是指这样一种现象，即估计值相对实际的被估计值的偏差越来越大使滤波器失去估计作用，因而会造成目标跟踪丢失。为了克服这个缺点，现已经发展了许多有效的滤波发散抑制方法或者算法，例如衰减记忆滤波法，限定记忆滤波法和自适应滤波法等。这些方法都是充分利用系统新的测量值对估计值进行修正。但是如果实际滤波过程中，在某一过程或者某种条件下测量值出现奇值，那么滤波结果会受到很大干扰。（完整word版）卡尔曼滤波器的设计关于雷达跟踪系统的定位（完整word版）卡尔曼滤波器的设计关于雷达跟踪系统的定位有时直接导致以后的滤波值不收敛，以至目标跟踪丢失.因此，如何解决好目标跟踪的稳定性（即滤波过程的

11、稳定性）也是我们所面临的问题。卡尔曼滤波算法中都很注意滤波的收敛速度问题，滤波收敛快慢直接影响到目标跟踪的稳定度和对目标的锁定速度，因此,滤波的收敛速度是评价一个滤波器性能的重要指标非线性滤波问题往往用状态变量方程来描述，从而可采用卡尔曼滤波的方法，并由此带来了一系列的方便。文献中一般对其中的加性噪声做均值为零的概率分布假设，即不存在系统偏差.这对于有些使用场合是不恰当的，或者说没有零均值假设,模型的适用范围更为广阔。当然，若该系统偏差事先已经知道，只要观测值减去该偏差然后再进行滤波即可。但如果该偏差存在而且未知，就需要在线处理这些系统偏差。在现阶段的民用雷达的跟踪系统中,普遍存在的问题就是跟

12、踪误差大，跟踪结果不收敛有时以至丢失目标的状况.这个问题在很多目标跟踪算法中都容易出现。其原因大致是由两点引起的:1建立目标运动模型的限制.2具体的跟踪算法的设计.例如在解决数据饱和的时候可以采用遗忘因子,在大多数的情况下这种算法是完全可以保证跟踪精度的，但是在测量值的前一时刻值为奇值甚至连续出现两个奇值的时候，遗忘因子的存在就影响了最后的估计精度。当采用前文所提到的一次扩展卡尔曼滤波的时候由于线性处理忽略了高阶项,当初始值选择不当时，这种算法的结果往往不收敛,即算法的稳定性不高二、卡尔曼滤波在达跟踪上的具体应用2.1研究题目假设有一个二坐标雷达对一平面上运动目标的进行观察，目标在t二0400

13、秒沿y轴作恒速直线运功，运动速度为一15m/s，目标的起点为（2000m,10000m），雷达扫描周期为2秒,x和y独立地进行观察，观察噪声的标准差均为100m。试建立雷达对目标的跟踪算法，并进行仿真分析，给出仿真结果，画出目标真实轨迹、对目标的观察和滤波曲线。2.2算法研究考虑利用卡尔曼滤波算法对目标的运动状态进行估计。由于目标在二维平面内做匀速运动,因此这里只考虑匀速运动情况。2。2。1跟踪算法由于目标沿y轴作匀速直线运动，取状态变量XS=yvy状态方程：S（k+1）=AS（k）（）观测方程：Z(k)=CS(k)+V(k)(2)其中,00_10zvxV=xzvyy对目标位置和速度的同时滤波

14、与一步预测的方程组如下:预测估计方程:S(k/k-1)=aS(k-1)预测误差协方差：P(k/k-1)=AP(-1)At滤波估计增益:()CT(k/k-1)-C(k/k-1匕+R，其中R-滤波估计方程：S(/k)=S(/k-1)+B(k)Z()-S(/k-1)滤波误差协方差：P(k/k)=11-B(k)Cb(k/k-1)2。2。2初始化利用目标的前几个测量值建立状态的其实估计,采用两点起始法。Z(2)xZ(2)yZ(2)-Z(1)yyTP(2/2)=Q2x0Q2yQ2yT0Q2寸2Q2yT滤波误差均值：etk)=x4*Si(k)-SIG/k)i=1滤波误差标准差：s(k)-sH/k)2。3仿真

15、分析利用MATLAB对前面建立的模型进行仿真，结果如下。目标真实轨迹12000100008000600040(19991999.21999.41999.61999.820002000.22000.42000.62000.82001X米)图2。1图2。1是目标运动的真实轨迹和观测轨迹曲线。其中，真实轨迹显示目标在x=2000米处沿y轴方向做匀速直线运动，而观测轨迹是目标运动的真实轨迹加上方差和随机测量噪声得到的。从图中可以看出，观测轨迹围绕真实轨迹作上下浮动。图2.2图2。2是单次滤波和100次滤波后的数据曲线。从图中可以看出，滤波刚开始时误差较大，之后滤波误差逐渐降低，估计值逐步逼近真实轨迹。

16、而随着滤波次数增加，滤波后的结果更为接近真实轨迹.图2.3图2。4图2。3,图2。4分别是x和y方向滤波估计误差均值及误差标准差曲线。从图上可以看出,滤波开始时误差较大，随着采样次数的增加，误差逐渐减小，误差的标准差也具有相同特性。另外，可以看到由于在y方向上有速度分量，因此y方向的估计误差均值比X方向的估计误差均值波动要大一些。三、总结卡尔曼滤波具有很多优秀的特质,我们可以通过改变它的参数或者构建比较合理的滤波模型来使它某一方面或者是几方面的特质达到具体工程的要求.因此在许多不同的工程应用中卡尔曼滤波的使用方法和本身算法不尽相同。这就看出了卡尔曼滤波在实际应用中的灵活性。由于卡尔曼滤波的诸多

17、优点，它先阶段在雷达跟踪的算法中占据着主导地位。UJ附录%仿真场景sigma=10000;T=2;t=200；Vy=15；C=100；010；A=100；01T；001；eSk（:，t）=000;eSz（:,t）=000;eeSz（:,t）=00；N=100;%蒙特卡洛次数fori=1:Nforj=1:tZk（：，j）=2000+wgn（1，1,40）;10000+Vy*T*（j1）+wgn（1，1,40）；endforj=1:200ifj=1Sk（:，1）=Zk（1,1），Zk（2，1），0;Sk1（:,1）=Sk（：,1）;Sk（：，2）=Zk（1，2），Zk（2,2），（Zk（2,2）-

18、Zk（2,1）/T;Sk1（:，2）=Sk（：，2）;Pk=sigma，0,0；0，sigma，sigma/T；0，sigma/T，2sigma/T；elseifj2Sk1（:,j）二A*Sk（:，j1）;%预测Pk1=A*Pk*A;%预测误差协方差Bk=Pk1*C*inv（C*Pk1*C+sigma*eye（2）;%kalman:增益Sk（:,j）=Sk1（:,j）+Bk*（Zk（:,j）-C*Sk1（:,j）;%滤波Pk=（eye（3）-Bk*C）*Pk1;%滤波协方差h+OOOOI)rxrv(二)4S600CN)+(?)Ns带二、UZS80柵瞅靈K%【N、(V二4SO匚*(t-o*a+ooootooocn)+(二NsHr)zsK%Z、(v二ls+(r二msH(、二msas-糕0001%pupu4更i醫琵扫哲窘8底平區POM證)二然ffl粵疑坦K001、)_苣(心二S、(二)Rs)40_d【(0匚、CN)10_dqns二、(*)oqewF(xJoqexx张祖粵戴坦KM(冊、)2-E二(&K(二)MshodHuCN)10_dqnsCun6