Algorytm grafowy - jaki zastosować ?

Witam,

Potrzebuje inspiracji :) Jaki algorytm powinienem do tego zadania zastosować, aby program był możliwie optymalny ? Mile widziana jest też jest ewentualna podpowiedź jak go wdrożyć (nie chodzi o pseudokod, tylko tak ogólnie :) )