Merge med Yvonnes del i BFS_Impl. Inte helt buggfritt