Működő, de lassú Dijkstra.

Signed-off-by: TakRaj <takraj@gmail.com>