RANSAC_cpp function

Apply RANSAC algorithm to estimate diameters.