Write me a function in C++ to find the distance between two points