Lines Matching refs:mat33Multiply

273     mat33Multiply(&wx2, &wx, &wx);  in fusionPredict()
349     mat33Multiply(&Pnew[0][0], &fusion->Phi0[0], &fusion->P[0][0]);  in fusionPredict()
350     mat33Multiply(&tmp, &fusion->Phi0[1], &fusion->P[1][0]);  in fusionPredict()
353     mat33Multiply(&Pnew[0][1], &fusion->Phi0[0], &fusion->P[0][1]);  in fusionPredict()
354     mat33Multiply(&tmp, &fusion->Phi0[1], &fusion->P[1][1]);  in fusionPredict()
449     mat33Multiply(&K[0], &fusion->P[0][0], &LtSi);  in fusionUpdate()
453     mat33Multiply(&K0L, &K[0], &L);  in fusionUpdate()
456     mat33Multiply(&K1L, &K[1], &L);  in fusionUpdate()
459     mat33Multiply(&tmp, &K0L, &fusion->P[0][0]);  in fusionUpdate()
462     mat33Multiply(&tmp, &K1L, &fusion->P[0][1]);  in fusionUpdate()
465     mat33Multiply(&tmp, &K0L, &fusion->P[0][1]);  in fusionUpdate()