Add distance (hypotenuse calculator) function

I'm not even using this yet, but I always end up needing it. Might as well write
it and test it now.