自编matlab卡尔曼滤波器函数及实例

function[x_p,p_p,k,x,p]=kal_n(A,Q,z,h,R,x_,p_)clc%ch-1problem-13clear%m：观测次数n：系统矩阵维度A=[11;01];%系统矩阵n*nQ=0;%系统噪声1*1z=[97.994.492.7];%观测值1*m%z=[97.994.492.790.287.584.682.679.877.5]';%观测值1*mh=[01];