shortest_path.pyに一部関数追加して中心点を表示するテストコードを書いてみました。

shortest_path.pyに一部関数追加して中心点を表示するテストコードを書いてみました。
書き方がかなり雑ですが、とりあえず動く感じです。