How to get distance of two vector points?