とりあえず

とりあえず、ルートを求める処理は出来てます
少々の改良と
（改良ってかスクリプトのサブルーチン化で呼び出せるように。です）
コメント書くのとサブルーチンの名前のリファクタリングが
TODOとして残ってるんですが
中途半端でも載せれば、眺めながらやる気出るかもしれないので
載せときますｗ

追記：一応、スクリプト完成したので削除ｗ