Munkres algorithm for the optimal assignment problem - View it on GitHub