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