Adding triangulateSimple and triangulation covariance estimation