一个悲催的修车工写的匈牙利算法

一、算法目的及要求
令X={x1,x2,x3…xn}表示工作人员的集合，Y={y1,y2…yn}表示工作集合。作一个二分图<Ｘ，Ｙ>，，规定Ｘｉ与Ｙｉ邻接当仅当Xi能胜任Yi，1<=i,j<= n，于是人员分配问题就转化为求二分图的一个完美匹配。

二、算法描述
从G中任取一个匹配M（初始匹配，可以是一条边），然后实施下列步骤：
（1）、若M饱和X的每个顶点，则算法停止（M就是问题的一个解），否则设u 属于 X是非M饱和点，令S：={ u }，T:=空集；转（2）；
（2）若Ng（S）=T，则|Ng（S）|<|S| 算法停止，无解，否则，任取y属于 Ng（S）-T,转（3）；
若y是M饱和的，则令S=S并{ z }，T=T并{ y}其中zy属于 M转（2）；否则，可得M可增广路P,取M和E（P）对称差，转（1）。

#include<stdio.h>
#define MAX 1e8
#define X 100
#define Y 100
static int G[X][Y]={0};
static int S[X]={0},T[X]={0};
static int Ng[X]={0};
static int P[X][2];
static int x,y;
void Init_Input_2c(int x,int y);
void Input_c(int side);				//
void Init_M_2c(int a,int b);	//

int PanduanM_2c(int a,int b);	//
int Choose_u_Update_S_2c(int a,int b);//
int PanduanNg_T_c(int a);//
int PanDuanIf_M_2c(int m,int n);//

void Update_G_c(int a);
void Output_G_2c(int a,int b);
void Update_Ng_2c(int a,int b);

//void Input_CheShi_2c(int a, int b);	//
//void CS_S_T_P(int a,int b)
int main(void)
{
	int side,flag=0,opt_X=0,opt_Y=0;
	int i=0,j=0;
	printf("Please enter total sides and x and y.\n");
	scanf("%d%d%d",&side,&x,&y);
	Init_Input_2c(x,y);
	Input_c(side);
	Init_M_2c(x,y);
//	Input_CheShi_2c(x,y);
//	printf("x%dy%d----------\n\n",x,y );//-------------
	while(PanduanM_2c(x,y)==-2)
	{		
		opt_X = Choose_u_Update_S_2c(x,y);//
//		printf("M %d\n", PanduanM_2c(x,y));//-------------
		while(PanduanNg_T_c(opt_X) != -1)//
		{			
			opt_Y=PanduanNg_T_c(opt_X);
//			printf("Ng_T:%d  x%d y%d\n",PanduanNg_T_c(opt_X),opt_X,opt_Y);//--------------------			
			P[i][j]=opt_X;P[i][j+1]=opt_Y;i++;//
			
//			CS_S_T_P(x,y);//-------------------------------
//			printf("ERROR 1------\n");
			if(PanDuanIf_M_2c(opt_Y,x)==-1) //
			{
					for(int n = 0; n < x; n++){		//
					if(G[n][opt_Y]==2) {
						S[n]=1;
						opt_X=n;
					}
					Update_Ng_2c(opt_X,y);//
					T[opt_Y]=1;//
				}
//			Input_CheShi_2c(x,y);//------
//				printf("ERROR2,Ybaoh---------\n");
			}
			else//涓嶉ケ鍜?
			{
				Update_G_c(i);
				i=0;j=0;
//				printf("Ybubaohe af==325\n");
//				Input_CheShi_2c(x,y);
				break;
			}			
		}
		if(PanduanNg_T_c(opt_X) == -1) //
		{
			printf("NO ANSER!\n");
		}

//		printf("---------------\n");
	}
//	Input_CheShi_2c(x,y);
	if(PanduanM_2c(x,y)==-1) Output_G_2c(x,y);


	return 0;
}
void Init_Input_2c(int x,int y)
{
	for(int i = 0; i < x; i++){
		for(int j = 0; j < y; j++)
		{
			G[i][j]=MAX;
		}
	}
}

void Input_c(int side)//
{
	int i,x,y;
	printf("Please enter x with y in turn.\n");
	for(i = 0 ;i < side; i++){
		scanf("%d%d",&x,&y);
		G[x-1][y-1]=1;
	}
}


void Init_M_2c(int a,int b)//
{
	for(int i = 0; i < a; i++){
		if(G[i][i] == 1) G[i][i]=2;
	}
	for(int i = 0; i <= a; i++)
	{
		for(int j = 0; j <= 2; j++)
			P[i][j]=0;
	} 
}

int PanDuanIf_M_2c(int m,int n)//
{
	int i;
	for(i = 0; i < n; i++) if(G[m][i] == 2) return -1;//
	if(i == n) return -2;
}
int PanduanM_2c(int a,int b)  //
{
	int i=0,j=0,flag=0;
	for(i = 0 ; i < a; i++)
	{
		for(j =0 ; j < b; j++)
		{
			if(G[i][j]==2){

			flag++;break;
//			printf("f %d i%d\n",flag,i );
			}
			
		}
	}
	if(flag==a) return -1;
	else return -2;
}
int Choose_u_Update_S_2c(int a,int b)//
{
	int u=-1,i,j;
	for( i = 0; i < a; i++){
		for( j = 0; j < b; j++){
			if(G[i][j] == 2) break;
		}
		if(j == b){ 
			u = i, S[u]=1;				//
			
			for( j = 0; j < b; j++){
				if(G[u][j] == 1)		//	
				Ng[j]=1;
			}
			break;
		}
	}
	return u;
}

int PanduanNg_T_c(int a)//
{
	int i;
	for(i = 0; i < x; i++){

		if(T[i] == Ng[i]){

			continue;
		}
		else return i;
	}
	if(i == a) { putchar('|') ;return -1;}
}

void Output_G_2c(int a,int b)
{
	int i,j;
	printf("One pipei is:\n");

	for(i = 0; i < 7*a; i++) printf("_"); putchar('\n');
	for(i = 0; i < a; i++){
		for(j = 0; j < b; j++){
			if(G[i][j] == 2){
				printf("x%d y%d  ",i+1,j+1);
				break;
			}
		}
	}
	printf("\n");
	for(i = 0; i < 7*a; i++) printf("_"); putchar('\n');
}
void Update_G_c(int a)//
{	
	for(int i = 0; i < a ; i++){
		G[ P[i][0]][ P[i][1] ]=2;
	}
	for(int i = 0; i < a-1; i++){
		G[P[i+1][0]][P[i][1]]=1;
	}
	for(int i = 0; i < x; i++){
		S[i]=0;T[i]=0;Ng[i]=0;
		P[i][0]=0;P[i][1]=0;
	}
}
void Update_Ng_2c(int a,int b)
{
	for(int i = 0; i < b ; i++)
		if(G[a][i] == 1) Ng[i]=1;
}

测试样例：

测试结果：