Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dorientation.c985 float fNorm; // quaternion Norm in fqAeqNormqA() local
988 fNorm = sqrtf(pqA->q0 * pqA->q0 + pqA->q1 * pqA->q1 + pqA->q2 * pqA->q2 + pqA->q3 * pqA->q3); in fqAeqNormqA()
989 if (fNorm > CORRUPTQUAT) in fqAeqNormqA()
992 fNorm = 1.0F / fNorm; in fqAeqNormqA()
993 pqA->q0 *= fNorm; in fqAeqNormqA()
994 pqA->q1 *= fNorm; in fqAeqNormqA()
995 pqA->q2 *= fNorm; in fqAeqNormqA()
996 pqA->q3 *= fNorm; in fqAeqNormqA()