则卡尔曼滤波的算法流程为： 1.计算预估计协方差矩阵2.计算卡尔曼增益矩阵3.更新估计4.计算更新后估计协防差矩阵-The Kalman filter algorithm processes as follows: 1. Calculate pre-estimate covariance matrix 2 calculate the Kalman gain matrix 3 updated estimate calculated after 4 update estimated defend d