Made a kalman filter