Use the correct Math method to calculate a hypotenuse.
Added method to calculate the 3D distance between two points
Added unit test for the new 3D distance method
Merge pull request #943 from arthurbenemann/3Ddistance

3D distance