误差生成程序 %Step1 X_kAnd1_k = A * X_k_k; %Step2 P_kAnd1_k = A* P_k_k * A' + Q_k; %Step3 K_kAnd1 = P_kAnd1_k * C' * ( C * P_kAnd1_k * C' + R_kAnd1)^-1; %Step4 X_k