最良優先探索
大文字で書かれた関数は以下の通り。全て引数にノードをとる。