brinv.h

来自「关于解析空三的全过程」· C头文件 代码 · 共 73 行

  #include "stdlib.h"
  #include "math.h"
  #include "stdio.h" 
 void nini(double **B,double **BJ,double w)
 {
	double temp1;
	int k;
	int i,j,m,n;
	for(i=0;i<w;i++)
	{
		//找到这一列中最大值所在的行
		temp1=B[i][i];k=i;
		for(j=i;j<w;j++)
		{
			if(B[j][i]>temp1)
			{
				temp1=B[j][i];
				k=j;
			}	

		}
		//交换，使得最大值在第一排
		if(k!=i)
		{
			for(m=0;j<6;j++)
			{
				temp1=B[i][m];
			    B[i][m]=B[k][m];
			    B[k][m]=temp1;
				temp1=BJ[i][m];
			    BJ[i][m]=BJ[k][m];
			    BJ[k][m]=temp1;

			}
		}

	    for(m=0;m<3;m++)
		{
			if(m!=i)
			{
				temp1=B[i][i]/B[m][i];
			    for(n=i;n<4;n++)	
				{
				   B[m][n]=temp1*B[m][n]-B[i][n];
                   BJ[m][n]=temp1*BJ[m][n]-BJ[i][n];
				}
			}
			
		}
		
		
		

	} 

	for(i=0;i<w;j++)
		for(j=0;j<w;j++)
		{
			BJ[i][j]=BJ[i][j]/B[i][i];
		}
	//
	for(m=0;m<3;m++)
	{
		for(n=0;n<4;n++)
		{
			cout<<B[m][n]<<"   ";
		}cout<<"\n";
	}

	
}