Home
last modified time | relevance | path

Searched refs:mat33Multiply (Results 1 – 3 of 3) sorted by relevance

/device/google/contexthub/firmware/os/algos/
Dfusion.c280 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/
Dmat.h82 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A,
Dmat.c91 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A, in mat33Multiply() function