Recovering Cholesky Factor in Smoothing and Mapping