Home
last modified time | relevance | path

Searched refs:Vec3 (Results 1 – 7 of 7) sorted by relevance

/device/google/contexthub/firmware/inc/algos/
Dvec.h26 struct Vec3 { struct
35 static inline void initVec3(struct Vec3 *v, float x, float y, float z) { in initVec3() argument
41 static inline void vec3Add(struct Vec3 *v, const struct Vec3 *w) { in vec3Add()
47 static inline void vec3Sub(struct Vec3 *v, const struct Vec3 *w) { in vec3Sub()
53 static inline void vec3ScalarMul(struct Vec3 *v, float c) { in vec3ScalarMul()
59 static inline float vec3Dot(const struct Vec3 *v, const struct Vec3 *w) { in vec3Dot()
63 static inline float vec3NormSquared(const struct Vec3 *v) { in vec3NormSquared()
67 static inline float vec3Norm(const struct Vec3 *v) { in vec3Norm()
71 static inline void vec3Normalize(struct Vec3 *v) { in vec3Normalize()
78 static inline void vec3Cross(struct Vec3 *u, const struct Vec3 *v, const struct Vec3 *w) { in vec3Cross()
Dfusion.h41 struct Vec3 x1;
47 struct Vec3 Ba, Bm;
50 struct Vec3 mData[3];
66 void fusionHandleGyro(struct Fusion *fusion, const struct Vec3 *w, float dT);
67 int fusionHandleAcc(struct Fusion *fusion, const struct Vec3 *a, float dT);
68 int fusionHandleMag(struct Fusion *fusion, const struct Vec3 *m);
71 void fusionGetBias(const struct Fusion *fusion, struct Vec3 *bias);
Dmat.h53 struct Mat33 *A, const struct Vec3 *v1, const struct Vec3 *v2, const struct Vec3 *v3);
55 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v);
82 void mat33Solve(const struct Mat33 *A, struct Vec3 *x, const struct Vec3 *b, const struct Size3 *pi…
84 void mat33GetEigenbasis(struct Mat33 *S, struct Vec3 *eigenvals, struct Mat33 *eigenvecs);
/device/google/contexthub/firmware/src/algos/
Dfusion.c132 static int fusion_init_complete(struct Fusion *fusion, int what, const struct Vec3 *d, float dT) { in fusion_init_complete()
143 struct Vec3 unityD = *d; in fusion_init_complete()
157 struct Vec3 unityD = *d; in fusion_init_complete()
171 struct Vec3 scaledD = *d; in fusion_init_complete()
195 struct Vec3 up = fusion->mData[0]; in fusion_init_complete()
197 struct Vec3 east; in fusion_init_complete()
205 struct Vec3 north; in fusion_init_complete()
226 static void matrixCross(struct Mat33 *out, struct Vec3 *p, float diag) { in matrixCross()
254 static void fusionPredict(struct Fusion *fusion, const struct Vec3 *w) { in fusionPredict()
258 struct Vec3 b = fusion->x1; in fusionPredict()
[all …]
Dmat.c44 …id initMatrixColumns(struct Mat33 *A, const struct Vec3 *v1, const struct Vec3 *v2, const struct V… in initMatrixColumns()
59 void mat33Apply(struct Vec3 *out, const struct Mat33 *A, const struct Vec3 *v) in mat33Apply()
304 void mat33Solve(const struct Mat33 *A, struct Vec3 *x, const struct Vec3 *b, const struct Size3 *pi… in mat33Solve()
344 void mat33GetEigenbasis(struct Mat33 *S, struct Vec3 *eigenvals, struct Mat33 *eigenvecs) in mat33GetEigenbasis()
Dmag_cal.c47 struct Vec3 eigenvals; in moc_eigen_test()
67 static int moc_fit(struct MagCal *moc, struct Vec3 *bias, float *radius) in moc_fit()
95 struct Vec3 v; in moc_fit()
218 struct Vec3 bias; in magCalUpdate()
/device/google/contexthub/firmware/src/drivers/orientation/
Dorientation.c318 struct Vec3 g, a; in updateOutput()
399 struct Vec3 a, w, m; in drainSamples()