Searched refs:mat33Multiply (Results 1 – 3 of 3) sorted by relevance
| /device/google/contexthub/firmware/src/algos/ |
| D | fusion.c | 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()
[all …]
|
| D | mat.c | 68 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A, const struct Mat33 *B) in mat33Multiply() function
|
| /device/google/contexthub/firmware/inc/algos/ |
| D | mat.h | 56 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A, const struct Mat33 *B);
|