Fix the `#distance` and `#distance_sq` methods

[leviongit]

These methods returned the difference of magnitudes of the two vectors instead of the distance between points.