Kuhn-Munkres (Hungarian) Algorithm in C++