fit_circle_cpp_modified function

This function fit a circle based on 3 points