replaced hungarian algorithmw with bipartite_matching from gaimc toolbox (need non-square A matrix)