Add an implementation of the Hungarian method
Add hungarian test case
Add debug output