make it compile
[protos/imu.git] / matrix.c
1 //Multiply two 3x3 matrixs. This function developed by Jordi can be easily adapted to multiple n*n matrix's. (Pero me da flojera!).
2 void Matrix_Multiply(float a[3][3], float b[3][3],float mat[3][3])
3 {
4         float op[3];
5         for(int x=0; x<3; x++) {
6                 for(int y=0; y<3; y++) {
7                         for(int w=0; w<3; w++) {
8                                 op[w]=a[x][w]*b[w][y];
9                         }
10                         mat[x][y]=0;
11                         mat[x][y]=op[0]+op[1]+op[2];
12
13                         float test=mat[x][y];
14                 }
15         }
16 }