Adding initial matrices for calculating using the kalman filter