Eigen algoritme opslaan

Het eigen algoritme wordt toegevoegd aan graaf.cpp