>>845 ダイクストラ法で二次配列にゴールまでのコスト入れて表示したらわかりやすいよ。