- (x1, y1, z1)の点
- (x2, y2, z2)の点
の間の距離は以下のように求まる。理由は俺は知らん。ピタゴラスに聞け。
double distance(double x1, double y1, double z1, double x2, double y2, double z2)
{
double dx = x2 - x1;
double dy = y2 - y1;
double dz = z2 - z1;
return sqrt(dx * dx + dy * dy + dz * dz);
}