How to find the magnitude of a vector between two points