C++ fitting circle program