Переписал все с испоьзованием boost graph_lib, исправил пару багов