matrix_functions.c

来自「f16的非线性模型设计」· C语言 代码 · 共 119 行 · 第 1/5 页

    ainv[0][1] = (a[0][2]*a[2][1]-a[2][2]*a[0][1])/det;
    ainv[1][1] = (a[0][0]*a[2][2]-a[2][0]*a[0][2])/det;
    ainv[2][1] = (a[0][1]*a[2][0]-a[2][1]*a[0][0])/det;
    
    ainv[0][2] = (a[0][1]*a[1][2]-a[1][1]*a[0][2])/det;
    ainv[1][2] = (a[0][2]*a[1][0]-a[1][2]*a[0][0])/det;
    ainv[2][2] = (a[0][0]*a[1][1]-a[1][0]*a[0][1])/det;
}

void matrix_transpose(double a[3][3], double atr[3][3])
{
   int i, j;
   for(i=0; i<3; i++)
   {
       for (j=0; j<3; j++)
       {
        atr[i][j] = a[j][i];
       }
   }
}

void mult_matrixvector6(double a[6][6], double b[6][1], double result[6][1])
{
   int i;