激しく直線同士の距離算出の実装が終わらない鮭家です。
微分が間違ってるのかなんなのか、もうグダグダ。

3次元恐怖症とかなりそうです。