Adding distance / distanceSquared + tests for issue: https://github.com/phetsims/dot/issues/1