版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、卡尔曼滤波 在雷达数据处理领域的仿真研究电信科学技术研究院PT1200057贾建超摘要本文对卡尔卡尔曼滤波器是直接针对时序或者连续状态而进行的状态空间转移滤波器,曼滤波在雷达数据处理中的应用进行仿真研究。本文基于CV 模型,假设雷达每隔时间T获得目标位置的数据,卡尔曼滤波器对观测到的数据进行处理,估计目标物体当前的状态及其参数,并对目标未来的状态及其参数进行预测。另外, 通过进一步的MATLAB 仿真实验,可知初值选取和系统参数对滤波器收敛速度和稳态精度的影响,以及系统模型和系统参数对机动目标跟踪性能的影响。关键词 : 卡尔曼滤波CV 模型 雷达 精度 跟踪性能AbstractKalman f
2、ilter is designed for continuous time sequences analysis or state analysis. The paper s purpose is to accomplish the simulation research for the application of Kalman filter in the field of radar data processing. Assuming that the radar receive the position data of target every T seconds, using CV m
3、odel, the filter will deal with the observation data, estimate the current state parameters of target and predict the future state. In addition, plenty of Matlab experiments are conducted. The results show the influence of initial data and system parameters to the filter s convergence velocity and p
4、recision of the steady state and they also present the influence of system model and system parameters to the performance of tracking of maneuvering targets obtained.Keywords: Kalman filter, CV model, radar, precision, tracking performance.第 0 章 前言信号的检测、估计和预测在信息与通信领域占有十分重要的地位,尤其在雷达系统中更是如此。 若忽略电磁波的速度
5、和脉冲周期的影响,理论上雷达可以测量到目标物的精确位置。但实际中,由于目标物的移动规律不稳定、电磁干扰、信号衰落等因素,测量过程中存在着不可忽略的噪声,这就需要我们利用检测、估计和预测理论进行比较准确的估计和滤波。在估计与预测方法中,线性无偏最小均方误差估计由于其良好的性能特点得到了更为大范围的应用。对于线性无偏最小均方误差的估计问题有两种滤波思路:维纳滤波和卡尔曼滤波。维纳滤波的思想是根据最小均方准则导出线性滤波器的维纳霍夫方程,通过解维纳霍夫方程即得到最优线性滤波器的冲激响应,滤波器的输出即为消息的最优线性估计。维纳滤波继承了维纳在随机过程理论的贯有风格与模式,它充分考虑了随机信号的相关特
6、性。但维纳滤波的限制也因此变得不容忽视,最主要的一点是维纳滤波只适合用于平稳随机过程,过程不平稳将导致维纳滤波必须不断地针对信号“修改参数”,而做到这一点的开销是十分巨大的。因此,维纳滤波非常不适合在实时性要求高的环境中应用。R.E.Kalman 等人于 60 年代初提出卡尔曼滤波方法,它直接从时域和状态入手,打破了平稳这一限制,计算机的计算得以更加方便。它的估计性能是线性最优的,而递推形式又能适应实时处理的需要,因此得到了广泛的应用。卡尔曼滤波器与维纳滤波器的不同点在于:1、不由协方差函数描述系统,而由白噪声策动的产生该过程的线性模型来表示;2、 不去寻找最佳滤波器的冲激响应,而是去寻找一套
7、算法直接得到消息的估计即使不能解析地求解微分方程,也总能容易的用计算机求解;3、不用时变的冲激响应描述产生消息的线性系统,而是用微分方程来描述,方程的解即为消息。第1章卡尔曼滤波的基本原理本文主要研究离散形式的卡尔曼滤波器。1.1 卡尔曼滤波原理为了描述系统状态,首先要建立消息模型:xk41 =6kxk +Gkuk其中n维矢量xk为消息,uk为r维策动噪声矢量。中卜为nn维转移矩阵或系统矩阵,Gk为n r维矩阵。接着对系统状态进行估计时需要建立测量模型:z k = H k x k十w k 线性观测其中Zk为m维观测矢量, wk为m维观测噪声。在开始进行卡尔曼滤波前需要已知的先验信息:EuJ =
8、&,Cov&,uj=Qk 心刈一一白噪声E(wj = wk , Covwfk,uj=R %白噪声Cov u k, wk.' = 0初值 E 0)=x0, Var&0)= P0Cov40, u J=0, Cov&0,w J=0限定滤波器为线性的:xk=Fk Zk+dk根据最优准则一最小均方误差准则,即求使k k k kJk = E&k -?k T xk -xk D在k时刻最小的系统状态(消息)xk的线性无偏、最小均方差递推滤波估计算法。多次利用矩阵求逆引理,可推导出卡尔曼滤波的递推形式:预测方程:k|k4 =":'kJ?kGkuk
9、4预测方差:Rik="RJ':4 Gy Q4 G:4滤波方差:Pk =(Pk;J HT RHQKk =PkkHT(Hk Pk|kHTRk)滤波增益:k k|kT k k k|kT k k /滤波方程:xk «k|k4 ' Kk Zk -(Hk父k|k J Wk)1.2 CV模型CV模型即匀速模型,假设目标是匀速运动,坐标x对时间t的二阶导数为0,把目标的加速度作为策动噪声处理。则消息的状态空间模型(xk_1=>kxk+Gkuk)和测量模型 k -1 k k k k(zk =Hk xk +wk)中的各个矩阵取值:XIXkykk 二 ykZk0 00 00
10、 00 01 T0 12|zy-zT2-2T_ 0 k -000T22 T000022 T1 0 0Hk = 0 0 10 0 0其中w(k ,u(k期别为策动噪声和观测噪声,均值都为0,且互不相关,此时消息状态模型和测量模型系数都不随时间变化。对于策动噪声协方差矩阵,考虑:T44T3T32T200Q1 =G Q Gr= 00T44T3200T32T2T443T3T2在实际的雷达数据处理过程中,观测数据是在方向余弦坐标系下得到的,而目标的状态方程是直角坐标系描述,因此观测噪声方差矩阵需要进行坐标系的转换:仃 x xy xy 仃 xz I_2R Dxy Oyyz yz2P xz yz z222:
11、 22二 x - -;R .-xy - >':'R。二二R-R:=2./2:2222二y - -;R R :二 yz - -;R -R2 -l:-;, -2/4 =¥2 pR+r2 a2 /Y2+R2 .P2 D2/Y2第2章仿真实验2.1 建立仿真环境本文进行的是 Matlab仿真,仿真流程为:产生目标轨迹 加入噪声 列出观测方程 进行卡尔曼滤波 作图与分析(1)产生目标轨迹匀速直线飞行目标匀加速直线飞行目标匀速圆周运动(2)观测噪声观测分别为R«,P ,其观测噪声分别为互相独立的零均值高斯白噪声 wR(k )wa(k )wp(k ),观测噪声方差为
12、:Or =100m,ba=bp = 0.1-(3)观测值极坐标系下的目标轨迹RT k = , x: kyT kz2 k- :T k =Xt k /RT kT k - yT k / Rr k雷达观测值R0 k = RT k 二 R Vr k 1 0 k =: T k 二k-0 k = -T k 一 v 一一 k其中VRiVvp分别为互相独立的零均值,标准差为1的高斯白噪声。2.2 实验结果及分析实验观测噪声距离噪声方差为了观察需要会进行改变,但在同一个仿真实验中不会变,俯仰角和方位角噪声方差均为0.1度。目标轨迹1 :匀速直线运动目标轨迹2:匀速直线运动 +匀速圆周运动 +匀速直线运动目标轨迹3
13、:匀加速直线运动目标轨迹如下:图0-1匀速直线运动图0-2匀速+圆周+匀速图0-3匀加速直线运动2.2.1初值选取对收敛速度的影响目标轨迹1,采样点数N=600,采样间隔T=0.1s ,策动噪声方差CTu=0.1g初值父(0 , p(0股无偏估计取值,图1-1,图 1-2,图 1-3;初值?0 )=0, p(0 )= I ,图 1-4,图 1-5,图 1-6。图1-1无偏初值距离误差图1-4初值为0距离误差方也甬坨薄谓鬓曲批图1-2无偏初值方位角误差惠傅意=感嬉方毛鱼均值二金曲续源濯阻差图1-5初值为0方位角误差苇尾一国民房.隹陆冲角均冒误爰国纨 . .u -0(ihyF-1差 手 T图1-3
14、无偏初值俯仰角误差图1-6初值为0俯仰角误差如果是无偏估计,滤波方程的起始条件应选为:E x?(0 y= E 1x(0 g p(0 )= px(0 )。由仿真结果得知,根据目标的初始状态建立起的滤波器的起始估计收敛速度较快。但在实际中,我们是无法得到目标的初始状态的,此时可以利用前两个观测值建立起始估计。如果初始值取值任意,不考虑它的无偏性,则滤波器的收敛速度就会较慢。2.2.2 系统参数T对收敛速度和稳态精度的影响目标轨迹3,初值按无偏估计取值,策动噪声方差仃u=0.1g采样点数N=100,采样间隔T=0.1s,图2-1;采样点数N=100,采样间隔T=1s,图2-2;采样点数N=100,采
15、样间隔T=5s,图2-3;采样点数 N=100,采样间隔 T=10s,图2-4。经实验证实,方位角和俯仰角的误差与距离误差规律一致,为减少不必要的篇幅,以下仅列出距离噪声仿真图。302010Q.ln-3Qa图2-1 T=0.1s的距离误差仿真雄51呼总方苣口 1g,久林间话T=IUlQn-10m 1WH雷晶也相图2-2 T=1s的距离误差仿真箫时哪声方差Dig.年择同喝T=s=饿劲嘴史方差口匕拜津问跳丁=1生初泡河差预测退型观测湿差:馥渔逢夏:视测谯爰图2-3 T=5s的距离误差仿真图2-4 T=10s的距离误差仿真由仿真结果得知,在一定范围内,采样间隔T不会影响到收敛速度,但会影响到稳态精度
16、,采样间隔越小,稳态精度越大。在采样间隔大到一定程度,则可能造成结果的不准确和不确定性。2.2.3 系统参数iu对收敛速度和稳态精度的影响目标轨迹1,初值按无偏估计取值,采样间隔 T=0.1s采样点数N=100,策动噪声方差 au =0.01g ,图3-1;采样点数N=100 ,策动噪声方差 ou =1g ,图3-2;采样点数N=100 ,策动噪声方差 au =5g ,图3-3;采样点数N=100 ,策动噪声方差 仃u =10g ,图3-4。同样,经实验证实,方位角和俯仰角的误差与距离误差规律一致,为减少不必要的篇幅,以下仅列出距离噪声仿真图。柔祥间KTR行第动唯声方差umg:爱凝讴笈 茂洲艮
17、至i 观图谩差图3-1策动噪声方差0.01g的距离误差10口-10加90图3-2策动噪声方差1g的距离误差图3-3策动噪声方差5g的距离误差用年可嗝同步空方差nJ加 0-W.3OM图3-4策动噪声方差10g的距离误差由策动噪声协方差矩阵可知Q正比于系统参数T,ou ,又根据卡尔曼滤波增益方程,滤1波增益K正比于Q R ,因而滤波增益 K正比于系统参数。“观察卡尔曼滤波方程 Xk=Xk/y + KkZk - Hk兄/-)可知,滤波增益K越大,最 新观测z在滤波值中的作用就越大,当 Kk .Hk = I时,滤波值x将完全依赖于最新的观测 值,则滤波失效。反之, K的值越小,观测 z在滤波值中的作用
18、就越小,当 K=0时,则新 的观测已经不起作用, 这时滤波值只是根据以前的观测数据按照动态模型递推得到,不再用新的观测值来修正滤波值,同样会造成滤波器的发散。可见,增益 K的值不能太大也不能 太小,否则都会引起滤波器发散, 通过推导可知K的取值范围在0和1之间。”(参考文献2)当选取适当的系统参数使增益K在滤波器正常工作的范围之内时,若系统参数取值越小,说明系统的策动噪声越小,等效于测量噪声加大,这时滤波增益K就要减小,使观测z在滤波值中的作用降低,即滤波值更多的依赖于预测值,则滤波和预测误差瞬态过程收敛速度越慢,但稳态精度越高。反之,系统参数取值越大,说明系统的策动噪声越大,等效于测 量噪声
19、减小,滤波增益增大,以加大观测z对滤波值的修正作用, 即滤波值更多的依赖于观 测值,使得滤波和预测误差瞬态过程收敛速度变快,但稳态精度降低。当系统参数取得足够大,使得增益K趋于1时,则滤波失效且滤波精度主要由测量误差方差所决定。2.2.4 系统参数T对机动目标跟踪性能的影响目标轨迹2,初值按无偏估计取值,采样点数N=600,策动噪声方差ou = 0.1g采样间隔T=0.1s,图4-1,图4-2,图4-3;采样间隔T=1s,图4-4,图4-5,图4-6。如套均值误差曲代一姆。误差秋测谣受图 4-1 距离误T= ( T=0.1s)图4-4距离误差(T=1s)方位角灯僧谒量曲线0 咽 2M 3M 4
20、00500图4-5万位角误差(T=1s)图4-2方位角误差(T=0.1s)1 口仰地均饱徨差由线激波薄莹 西测误世L观测镌芝1QQ 200刘048500图4-6俯仰角误差(T=1s)图4-3俯仰角误差(T=0.1s)由仿真结果可知,运动状态的改变,会引起系统的暂时不稳定。策动噪声方差一定的情 况下,一定范围内,采样间隔越小机动目标跟踪性能越好。2.2.5 系统参数。u对机动目标跟踪性能的影响目标轨迹2,初值按无偏估计取值,采样点数N=600,采样间隔T=0.1s策动噪声方差 Ou =0.1g,图5-1,图5-2,图5-3;策动噪声方差 仃u =1g ,图5-4,图5-5,图5-6。疵演定士 M:界底壁 现:更I误整图4-1距离误差(策动方差0.1g)图4-4距离误差(策动方差1g)侬 *3加 400 的E位的的倡看差曲然旧 城 5 QCI1膻 O.Q Q. 4 万自由均值宜庠由域谭或误经- 曾蜀误经 规潜误差|1M 武。地 讪图4-2方位角误差(策动方差0.1g)_ : :0 Ol£> ;一 -油至
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 年产xxx核电站发电项目建议书
- 年产xx橡胶密封垫圈项目建议书
- 儿童灯项目可行性研究报告
- 2024年高性能陶瓷复合材料项目资金筹措计划书
- 中班教案:春天的小使者
- 煤矿顶板安全培训
- 2022-2023学年广东省深圳市宝安区六年级上学期期末英语试卷
- 大班空气教案11篇
- 季羡林《我的童年》说课稿
- 小班社会教案:小熊讲理啦
- 柯蒂斯控制器课件
- 电池中英文报价单模版
- 延长石油油气勘探公司钻井定向施工总结(模板)3.28
- 电影放映经营许可证延期换证申请登记表
- Linux网络设备驱动程序培训教材(共29页).ppt
- 跨越架搭拆专项施工方案(共22页)
- API-685-中文_
- 中国石油化工集团公司电气设备及运行管理规定
- 2014年光电子技术思考题答案
- 无压烧结碳化硅陶瓷防弹片的生产工艺设计
- 温度传感器单片机实训
评论
0/150
提交评论