Home
last modified time | relevance | path

Searched refs:Mat33 (Results 1 – 9 of 9) sorted by relevance

/device/google/contexthub/firmware/os/algos/common/math/
Dmat.h44 struct Mat33 { struct
61 void initZeroMatrix(struct Mat33 *A); argument
68 void initDiagonalMatrix(struct Mat33 *A, float x);
72 void initMatrixColumns(struct Mat33 *A, const struct Vec3 *v1,
77 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v);
81 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A,
82 const struct Mat33 *B);
86 void mat33ScalarMul(struct Mat33 *A, float c);
90 void mat33Add(struct Mat33 *out, const struct Mat33 *A);
94 void mat33Sub(struct Mat33 *out, const struct Mat33 *A);
[all …]
Dmat.c39 static void mat33SwapRows(struct Mat33 *A, uint32_t i, uint32_t j);
40 static uint32_t mat33Maxind(const struct Mat33 *A, uint32_t k);
41 static void mat33Rotate(struct Mat33 *A, float c, float s, uint32_t k,
46 void initZeroMatrix(struct Mat33 *A) { in initZeroMatrix()
52 void initDiagonalMatrix(struct Mat33 *A, float x) { in initDiagonalMatrix()
62 void initMatrixColumns(struct Mat33 *A, const struct Vec3 *v1, in initMatrixColumns()
81 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v) { in mat33Apply()
91 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A, in mat33Multiply()
92 const struct Mat33 *B) { in mat33Multiply()
115 void mat33ScalarMul(struct Mat33 *A, float c) { in mat33ScalarMul()
[all …]
Dquat.h28 void initQuat(Quat *q, const struct Mat33 *R);
29 void quatToMatrix(struct Mat33 *R, const Quat *q);
Dquat.c21 void initQuat(Quat *q, const struct Mat33 *R) { in initQuat()
35 void quatToMatrix(struct Mat33 *R, const Quat *q) { in quatToMatrix()
/device/google/contexthub/firmware/os/algos/
Dfusion.c213 struct Mat33 R; in fusion_init_complete()
233 static void matrixCross(struct Mat33 *out, struct Vec3 *p, float diag) { in matrixCross()
270 struct Mat33 I33; in fusionPredict()
273 struct Mat33 I33dT; in fusionPredict()
276 struct Mat33 wx; in fusionPredict()
279 struct Mat33 wx2; in fusionPredict()
301 struct Mat33 O33; in fusionPredict()
322 struct Mat33 tmp = wx; in fusionPredict()
355 struct Mat33 Pnew[2][2]; in fusionPredict()
400 static void scaleCovariance(struct Mat33 *out, const struct Mat33 *A, const struct Mat33 *P) { in scaleCovariance()
[all …]
/device/google/contexthub/firmware/os/inc/algos/
Dfusion.h44 struct Mat33 P[2][2];
45 struct Mat33 GQGt[2][2];
47 struct Mat33 Phi0[2];
86 void fusionGetRotationMatrix(const struct Fusion *fusion, struct Mat33 *R);
/device/google/contexthub/firmware/os/algos/calibration/magnetometer/mag_cal/
Dmag_cal.c54 struct Mat33 S; in moc_eigen_test()
63 struct Mat33 eigenvecs; in moc_eigen_test()
/device/google/contexthub/firmware/os/algos/calibration/accelerometer/
Daccel_cal.c382 struct Mat33 S; in accEigenTest()
391 struct Mat33 eigenvecs; in accEigenTest()
/device/google/contexthub/firmware/os/drivers/orientation/
Dorientation.c347 struct Mat33 R; // direction-cosine/rotation matrix, inertial -> device in updateOutput()