First working edmund-karp in C++