高斯列主元消去法解线性方程组

最近在看惯导的东西，然后想要用C++解惯导控制方程，然后就重头把C++解方程组这方面的知识回顾了一下，首先就是高斯列主元消去法，这个方法还算实用，这里以3*3的矩阵为例，里面注释很详细，各位小白可以参考参考hhh

//顺序高斯消去法求线性方程组的解  AX=B,A为系数矩阵，B为常向量矩阵，X为矩阵的解
//为了减小误差，采用列主元消去法，从第k列的a[k][k]及其以下的各元素中选取绝对值最大的元素，然后行变换将这两行交换位置
//对于非奇异矩阵并且消元过程中第K步的主对角线上的元素不为0,就可以用高斯消元法来求解

#include<iostream>
const int n=3;
void Gauss_elimination(double a[n][n],double b[n])
{
	double x[n];//解的存储数组
	int i,j,k;
	double aa[n];//左上的主对角元素为0时系数矩阵的行相互交换
	double bb;//左上的主对角元素为0时系数矩阵的行相互交换
	double mm;//找出最大的a[m][k]行的a[m][k]
	int m;//找出最大的a[m][i]行的行m值
	double c[n];//存储初等行变换的系数，用于行的相减
	for(k=0;k<n-1;k++)	 //消元的整个过程如下，总共n-1次消元过程。
	{
		mm=a[k][k];m=k;bb=0;
		for(int i=1;i<n-k;i++)//找出最大的绝对值a[m][k]行的行m值
		{
			if(mm<abs(a[k+i][k]))
			{m=k+i;mm=abs(a[k+i][k]);}
		}
		if(mm==0)              //此种情况表明a[