matrix_functions.c

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

   for(i=0; i<6; i++)
   {
		  result[i][0] = a[i][0] * b[0][0] + a[i][1] * b[1][0] 
          + a[i][2] * b[2][0]+ a[i][3] * b[3][0]+ a[i][4] * b[4][0]
          + a[i][5] * b[5][0];
   }
}

void mult_matrixmatrix6(double a[6][6], double b[6][6], double result[6][6])
{
   int i, j;
   for(i=0; i<6; i++)
   {
       for (j=0; j<6; j++)
       {
		  result[i][j] = a[i][0] * b[0][j] + a[i][1] * b[1][j] 
          + a[i][2] * b[2][j]+ a[i][3] * b[3][j]+ a[i][4] * b[4][j]
          + a[i][5] * b[5][j];
       }
   }

}

void matrix_sub6(double a[6][6], double b[6][6], double result[6][6])