Fix tools for PR FixLocalSurfelEstimator