Add DistanceSquared functions