Adding Kalman filter and linear system