矩阵求逆 代码

/*************************************************************************************
* 矩阵转置函数(MResult = MOrigin(T))，参数说明:
*   MOrigin   - 原始矩阵，以一维数组形式存储，m行n列
*   MResult   - 转置后矩阵，以一维数组形式存储，n行m列
*************************************************************************************/
void Transpose(double *MOrigin, double *MResult, int m, int n)
{
int i, j;
for(i=0; i<n; i++)
   for(j=0; j<m; j++)
    MResult[i*m+j] = MOrigin[j*n+i];
}

/*************************************************************************************
* 矩阵求逆函数(Metrix = Metrix(-1))，参数说明:
*   Metrix - 原始矩阵，也是求逆之后的矩阵，以一维数组形式存储，n行n列
*************************************************************************************/
void Inverse(double *Metrix, int n)
{
int i, j, k;
    for(k=0; k<n; k++)
{
   for(i=0; i<n; i++)
   {
    if(i != k)
     Metrix[i*n+k] = - Metrix[i*n+k] / Metrix[k*n+k];
   }
   Metrix[k*n+k] = 1/Metrix[k*n+k];
  
   for(i=0; i<n; i++)
   {
    if(i != k)
    {
     for(j=0; j<n; j++)
     {
      if(j != k)
       Metrix[i*n+j] += Metrix[k*n+j] * Metrix[i*n+k];
     }
    }
   }
  
   for(j=0; j<n; j++)
   {
    if(j != k)
     Metrix[k*n+j] *= Metrix[k*n+k];
   }
}
}

/*************************************************************************************
* 矩阵相乘函数(MResult = MOrigin1 * MOrigin2)，参数说明:
*   MOrigin1 - 原始矩阵1，以一维数组形式存储，m行n列
*   MOrigin2 - 原始矩阵2，以一维数组形式存储，n行l列
*   MResult   - 相乘后矩阵，以一维数组形式存储，m行l列
*************************************************************************************/
void Multiply(double *MOrigin1, double *MOrigin2, double *MResult, int m, int n, int l)
{
int i, j, k;
for(i=0; i<m; i++)
   for(j=0; j<l; j++)
   {
    MResult[i*l+j] = 0.0;
            for(k=0; k<n; k++)
     MResult[i*l+j] += MOrigin1[i*n+k] * MOrigin2[j+k*l];
   }
}

/*************************************************************************************
* 矩阵相减函数(MResult = MOrigin1 - MOrigin2)，参数说明:
*   MOrigin1 - 原始矩阵1，以一维数组形式存储，m行n列
*   MOrigin2 - 原始矩阵2，以一维数组形式存储，m行n列
*   MResult   - 相减后矩阵，以一维数组形式存储，m行n列
*************************************************************************************/
void Minus(double *MOrigin1, double *MOrigin2, double *MResult, int m, int n)
{
int i, j;
for (i=0; i<m; i++)
   for (j=0; j<n; j++)
    MResult[n*i+j] = MOrigin1[n*i+j] - MOrigin2[n*i+j];
}