PPT Slide
Initialization
- Initialize the state vector x 1,p & the covariance matrix C 1,p
Filtering and prediction steps
BEGIN FILTERING LOOP (k) ========
- Calculate the residuals for the prediction
- Calculate the gain matrix
- Update the state vector
-
- Update the covariance matrix
-