1
2
3
4
5
6
7
distance(p1,p2) {
int x,y,z;
x=p2.x-p1.x;
y=p2.y-p1.y;
z=p2.z-p1.z;
return sqrt(x*x+y*y+z+z);
}