Calculate a distance between two points