経路探索処理(A*)を作った。多分動いていそう。いくつかバグも修正した。

せっかくなので特性機能を作ってみる。