Maximum likelihood kalman filter