double costs[N_LEFT][N_RIGHT]; // Es muss l<=r sein! (sonst Endlosschleife) double match(int l, int r) { vector lx(l), ly(r); //xy is matching from l->r, yx from r->l, or -1 vector xy(l, -1), yx(r, -1), augmenting(r); vector s(l); vector> slack(r); for (int x = 0; x < l; x++) lx[x] = *max_element(costs[x], costs[x] + r); for (int root = 0; root < l; root++) { augmenting.assign(r, -1); s.assign(l, false); s[root] = true; for (int y = 0; y < r; y++) { slack[y] = {lx[root] + ly[y] - costs[root][y], root}; } int y = -1; while (true) { double delta = INF; int x = -1; for (int yy = 0; yy < r; yy++) { if (augmenting[yy] < 0) { if (slack[yy].first < delta) { delta = slack[yy].first; x = slack[yy].second; y = yy; }}} if (delta > 0) { for (int x = 0; x < l; x++) if (s[x]) lx[x] -= delta; for (int y = 0; y < r; y++) { if (augmenting[y] >= 0) ly[y] += delta; else slack[y].first -= delta; }} augmenting[y] = x; x = yx[y]; if (x == -1) break; s[x] = true; for (int y = 0; y < r; y++) { if (augmenting[y] < 0) { double alt = lx[x] + ly[y] - costs[x][y]; if (slack[y].first > alt) { slack[y] = {alt, x}; }}}} while (y >= 0) { // Jede Iteration vergrößert Matching um 1 // (können 0-Kanten sein!) int x = augmenting[y]; int prec = xy[x]; yx[y] = x; xy[x] = y; y = prec; }} // Wert des Matchings return accumulate(lx.begin(), lx.end(), 0.0) + accumulate(ly.begin(), ly.end(), 0.0); }