Lines Matching refs:mat33Multiply

280     mat33Multiply(&wx2, &wx, &wx);  in fusionPredict()
356     mat33Multiply(&Pnew[0][0], &fusion->Phi0[0], &fusion->P[0][0]);  in fusionPredict()
357     mat33Multiply(&tmp, &fusion->Phi0[1], &fusion->P[1][0]);  in fusionPredict()
360     mat33Multiply(&Pnew[0][1], &fusion->Phi0[0], &fusion->P[0][1]);  in fusionPredict()
361     mat33Multiply(&tmp, &fusion->Phi0[1], &fusion->P[1][1]);  in fusionPredict()
456     mat33Multiply(&K[0], &fusion->P[0][0], &LtSi);  in fusionUpdate()
460     mat33Multiply(&K0L, &K[0], &L);  in fusionUpdate()
463     mat33Multiply(&K1L, &K[1], &L);  in fusionUpdate()
466     mat33Multiply(&tmp, &K0L, &fusion->P[0][0]);  in fusionUpdate()
469     mat33Multiply(&tmp, &K1L, &fusion->P[0][1]);  in fusionUpdate()
472     mat33Multiply(&tmp, &K0L, &fusion->P[0][1]);  in fusionUpdate()