资源描述：
《信号检测与估值作业-副本》由会员上传分享，免费在线阅读，更多相关内容在工程资料-天天文库。
1、一、实验原理21、卡尔曼滤波器简介：22、卡尔曼滤波器的递推公式：2二、设计内容2三、MATLAB程序设计3四、图形结果6卡尔曼滤波算法及其MATLAB实现一、原理介绍1、卡尔曼滤波器简介：(1)卡尔曼滤波是用状态空间法描述系统的，有状态方程和量测方程所组成。卡尔曼滤波用前一个状态的的估计值和最近一个观测数据来估计状态变量的当前值，并以状态变量的估计值的形式给出。卡尔曼滤波具有以下特点：算法是递推的，且状态空间法采用在时域内设计滤波器的方法，因而适用于多维随机过程的设计；离散型卡尔曼算法适用于计算机处理。(2)用递推法计算，不需要知道全部过去的值，用
2、状态方程描述状态变量的动态变化规律，因此信号可以是平稳的，也可以是非平稳的，即卡尔曼滤波适用于非平稳过程。(3)卡尔曼滤波采取的误差准则仍为估计误差的均方值最小。卡尔曼滤波器是解决以均方误差最小为准则的最佳线性滤波问题，它根据前一个估计值和最近一个观察数据來佔计信号的当前值。它是用状态方程和递推方法进行佔计的，而它的解是以状态变量的估计量的形式给出的。卡尔曼滤波中信号和噪声是用状态方程和测量方程来表示的，因此设计卡尔曼滤波器耍求已知状态方程和测量方程。它不需要知道全部过去的数据，采用递推的方法计算，它既可以解决平稳的和不平稳的随机过程，同时也可以应用
3、解决非时变和时变系统，应用较为广泛。2、卡尔曼滤波器的递推公式：一1)=X伙一1伙一1)P{kk-)=A^P{kk-)Ar+B^QX(kk)=X(kk-i)+K伙)(Z伙)—H*Z伙丨R—1))P(k1*)=(/-K(k)*H)*P(£IP-1)K伙)=P伙丨R—1)*丹丁*(R(k)+H*P伙伙—1)*丹丁尸二、设计内容基于匀速直线运动的卡尔曼滤波器的仿真：-•物体在二维平面内做匀速直线运动，沿X轴方向的速度为vx=10m/s,vy二10m/s,初始位置x=20m,y=20m;采样周期T二Is,系统过程噪声假设为零均值的高斯白噪声，设X
4、=[x;vx;y;vy],则X的状态方程为：X(k+l)=A*X(k)+B*U(k)~lT0Q~7八2/20_0100T0,B=001T0TA2/200010T其屮A二过程噪声的自相关矩阵为QK二[30,20;02(T2];观测方程为：Z(k)=H*X(k)+W(k)其中观测矩阵H=o0,,z(k)=zx(k)zx(k),zy(k)分别为k时刻H标在两方向的位置x(k),y(k)的测量值。观测噪声的自相关矩阵为RK=qxx(k)qxy(k)qxy(k)qyy(k)1=2.5A2*0状态误差自相关矩阵按卜•式进行初始化:qxx(V)/Tqxy(l)P0
5、=计算可得：qxx(l)/Tqxy⑴qxy()!T2^xx(l)/TA2qxy⑴/T2理y(l)/"2qxy(S)ITqyy⑴qyy⑴/tqyy⑴/T2^7(1)/TA22.5A22.5A2/T0P0=2.5A2/T02*25A2/TA202.5A202.5八2/72.5A2/T2*2.5A2/TA2利用前两个时刻的观测值Z(l)和Z(2)来确定初始状态的估计值:X(111)=[zx(2);(zx(2)-zx(l))/T;zy(2);(zy(2)-zy(l))/T].三、MATLAB程序设计clear;T=l;A=[lT00;0100;001T;O
6、001];H=[lOOO;OO10];B=[TA2/20;T0;0TA2/2;0T];X=zeros(4,200)Xl=[20;10;20;10];X(:,1)=X1Z0=[10;10];Zl=[20;20];Z=zeros(2,200);Z(:,1)=ZO;M=zeros(4,2*200);P0=[2.5A22.5A2/T00;2.5A2/T2*2.5A2/TA200;002.5A22.5A2/T;002.5八2AT2*2.5A2/TA2];P=[P0zeros(4,4*199)J;U=randn(2,200);X_r=zeros(4,200);X
7、_r(:J)=[20;10;20;10];X_R=zeros(4,200);X_R(:,l)=[20;10;20;10J;%X的真实值%没加噪声的x的值forn=l:200X_r(:,n+l)=A*X_r(:,n)+B*U(:,n);endform=l:200X_R(:,m+l)二A*X_R(:,m);endforK=1:200i=4*(K-l)+lj=2*(K・l)+lRK=2.5A2*ll0;01J;QK=[30A20;020A2];W=randn(2,200);Z(:,K)=H*X(:,K)+W(:,K);M(:,j:j+l)=(A*P(:,i
8、:i+3)*A4B*QK*B')*H'*inv(H*(A*P(:,i:i+3)*A4B*QK*B')*H'+
