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
62 void initZeroMatrix(struct Mat33 *A); argument
69 void initDiagonalMatrix(struct Mat33 *A, float x);
73 void initMatrixColumns(struct Mat33 *A, const struct Vec3 *v1,
78 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v);
82 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A,
83 const struct Mat33 *B);
87 void mat33ScalarMul(struct Mat33 *A, float c);
91 void mat33Add(struct Mat33 *out, const struct Mat33 *A);
95 void mat33Sub(struct Mat33 *out, const struct Mat33 *A);
[all …]
Dmat.c40 static void mat33SwapRows(struct Mat33 *A, uint32_t i, uint32_t j);
41 static uint32_t mat33Maxind(const struct Mat33 *A, uint32_t k);
42 static void mat33Rotate(struct Mat33 *A, float c, float s, uint32_t k,
47 void initZeroMatrix(struct Mat33 *A) { in initZeroMatrix()
53 void initDiagonalMatrix(struct Mat33 *A, float x) { in initDiagonalMatrix()
63 void initMatrixColumns(struct Mat33 *A, const struct Vec3 *v1, in initMatrixColumns()
82 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v) { in mat33Apply()
92 void mat33Multiply(struct Mat33 *out, const struct Mat33 *A, in mat33Multiply()
93 const struct Mat33 *B) { in mat33Multiply()
116 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.c55 struct Mat33 S; in moc_eigen_test()
64 struct Mat33 eigenvecs; in moc_eigen_test()
/device/google/contexthub/firmware/os/algos/calibration/accelerometer/
Daccel_cal.c387 struct Mat33 S; in accEigenTest()
396 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()