#include"MatrixGauss.h"

// ガウスの消去法(ピボット選択)
void MatrixGauss(double *matrix,unsigned char lines)
{
	double d,max;
	int i,j,k,s;

	for(k=0;k<lines-1;k++){
		// ピボット選択
		max=0; s=k;
		for(i=k;i<lines;i++){
			if(fabs(matrix[i*(lines+1)+k])>max){
				max=fabs(matrix[i*(lines+1)+k]);
				s=i;
			}
		}
		for(j=k;j<lines+1;j++){
			d=matrix[k*(lines+1)+j];
			matrix[k*(lines+1)+j]=matrix[s*(lines+1)+j];
			matrix[s*(lines+1)+j]=d;
		}
		// 前進消去
		for(i=k+1;i<lines;i++){
			d=matrix[i*(lines+1)+k]/matrix[k*(lines+1)+k];
			for(j=k+1;j<=lines;j++){
				matrix[i*(lines+1)+j]-=matrix[k*(lines+1)+j]*d;
			}
		}
	}
	// 後退代入
	for(i=lines-1;i>=0;i--){
		d=matrix[i*(lines+1)+lines];
		for(j=i+1;j<lines;j++){
			d-=matrix[i*(lines+1)+j]*matrix[j*(lines+1)+lines];
		}
		matrix[i*(lines+1)+lines]=d/matrix[i*(lines+1)+i];
	}
}