Home
last modified time | relevance | path

Searched refs:pfq (Results 1 – 2 of 2) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c1028 void fveqconjgquq(Quaternion *pfq, float fu[], float fv[]) in fveqconjgquq() argument
1036 pfq->q0 = ONEOVERSQRT2 * fsqrt1plusudotv; in fveqconjgquq()
1048 pfq->q1 = -fuxv[CHX] * ftmp; in fveqconjgquq()
1049 pfq->q2 = -fuxv[CHY] * ftmp; in fveqconjgquq()
1050 pfq->q3 = -fuxv[CHZ] * ftmp; in fveqconjgquq()
1056 pfq->q1 = fu[CHY] - fu[CHZ]; in fveqconjgquq()
1057 pfq->q2 = fu[CHZ] - fu[CHX]; in fveqconjgquq()
1058 pfq->q3 = fu[CHX] - fu[CHY]; in fveqconjgquq()
1060 ftmp = sqrtf(fabsf(pfq->q1 * pfq->q1 + pfq->q2 * pfq->q2 + pfq->q3 * pfq->q3)); in fveqconjgquq()
1065 pfq->q1 *= ftmp; in fveqconjgquq()
[all …]
Dorientation.h175 Quaternion *pfq,