Kalman Filter Matlab -

Corrects that guess using new, noisy sensor data.

% --- Kalman Filter Steps ---

% 2. UPDATE % Calculate Kalman Gain S = H * P_pred * H' + R; % Innovation covariance K = P_pred * H' / S; % Kalman Gain kalman filter matlab

est_pos(k) = x(1);