追記
経路検索はダイクストラとA*の二種類に対応
どちらも重み付けに対応している方法なのでその処理を書き足せば重み付けありにできるはず