最良優先探索
ノード探索終了判定関数:ゴールに到達したかどうか。
A* の論文では、上記の visited を CLOSED、queue を OPEN と呼ぶ。