Added sqrDistance to Vector
Tries on long range heuristics
Mark points in output