function d=getdistsq(p1,p2);
% function d=getdistsq(p1,p2);
%
%	Returns distance^2 between p1 and p2

d=(p1(1)-p2(1))^2 + (p1(2)-p2(2))^2 + (p1(3)-p2(3))^2;