matrix_functions.c

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

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

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

}