distance static method
Find the distant between p1
and p2
Implementation
static double distance(List<double> p1,List<double > p2 ){
double xd = p2[0]-p1[0];
double yd = p2[1]-p1[1];
double zd = p2[2]-p1[2];
return math.sqrt(xd*xd + yd*yd + zd*zd);
}