Kalman Filter For Beginners With Matlab Examples Download Here

% Initialize the state and covariance x0 = [0; 0]; % initial state P0 = [1 0; 0 1]; % initial covariance