LA4043二分图最佳匹配（注意建模）

/*LA4043
1<=n<=100
给定两个集合A,B，每个集合的n个元素的坐标，以欧几里得距离为权值。
求一个A到B的一一映射，每一对相互连线，使得，没有任何两条线是相交的。

这道题有个特解：A和B的最佳匹配（使负的权值和最大），因为两条交叉的线，能换成两条不交叉的，从而增大负权值和。
*/
#include <cmath>
#include <algorithm>
#include <stdlib.h>
#include <iostream>
#include <string.h>
#include <stdio.h>
#include <stack>
#include <set>
#include <map>
#include <vector>
#define typed double
#define INF 1<<30
#define maxn 110
#define eps 1e-6
using namespace std;
int n;
typed W[maxn][maxn];
typed Lx[maxn],Ly[maxn];
int lef[maxn];
bool S[maxn],T[maxn];

bool match(int i){
    S[i]=true;
    for(int j=1;j<=n;j++) if (fabs(Lx[i]+Ly[j]-W[i][j])<eps && !T[j]){
        T[j]=true;
        if (!lef[j] || match(lef[j])){
            lef[j]=i;
            return true;
        }
    }
    return false;
}

void update(){
    typed a=INF;
    for(int i=1;i<=n;i++) if(S[i]){
        for(int j=1;j<=n;j++) if(!T[j])
            a=min(a,Lx[i]+Ly[j]-W[i][j]);
    }
    for(int i=1;i<=n;i++){
        if (S[i]) Lx[i]-=a;
        if (T[i]) Ly[i]+=a;
    }
}
void KM(){
    for(int i=1;i<=n;i++){
        lef[i]=Lx[i]=Ly[i]=0;
        for(int j=1;j<=n;j++){
            Lx[i]=max(Lx[i],W[i][j]);
        }
    }
    for(int i=1;i<=n;i++){
        for(;;){
            for(int j=1;j<=n;j++) S[j]=T[j]=false;
            if (match(i)) break;else update();
        }
    }
}
typed AX[maxn],AY[maxn];
typed BX[maxn],BY[maxn];
double dis(int u,int v){
    double ans=-sqrt((BX[u]-AX[v])*(BX[u]-AX[v])+(BY[u]-AY[v])*(BY[u]-AY[v]));
    return ans;
}
void read(){
    for(int i=1;i<=n;i++) scanf("%lf%lf",&AX[i],&AY[i]);
    for(int i=1;i<=n;i++) scanf("%lf%lf",&BX[i],&BY[i]);
    for(int i=1;i<=n;i++)
    for(int j=1;j<=n;j++)
    W[i][j]=dis(i,j);
}
int t=0;
int main(){
    while(cin>>n){
        t++;
        read();
        KM();
        if (t>1) printf("
");
        for(int i=1;i<=n;i++) printf("%d
",lef[i]);
    }
    return 0;
}