[c#] Calculating the distance between 2 points