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