Get distance from this point to another point
double distanceTo(Vec3 p) { final px = p.x; final py = p.y; final pz = p.z; return math.sqrt((px - x) * (px - x) + (py - y) * (py - y) + (pz - z) * (pz - z)); }