Searched refs:fqMi (Results 1 – 1 of 1) sorted by relevance
647 Quaternion fqMi; // a priori orientation quaternion in fRun_6DOF_GY_KALMAN() local676 fqMi = pthisSV->fqPl; in fRun_6DOF_GY_KALMAN()693 qAeqAxB(&fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()702 qAeqAxB(&fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()738 ftmpMi3x1[CHX] = 2.0F * (fqMi.q1 * fqMi.q3 - fqMi.q0 * fqMi.q2); in fRun_6DOF_GY_KALMAN()739 ftmpMi3x1[CHY] = 2.0F * (fqMi.q2 * fqMi.q3 + fqMi.q0 * fqMi.q1); in fRun_6DOF_GY_KALMAN()740 ftmpMi3x1[CHZ] = 2.0F * (fqMi.q0 * fqMi.q0 + fqMi.q3 * fqMi.q3) - 1.0F; in fRun_6DOF_GY_KALMAN()961 qAeqBxC(&(pthisSV->fqPl), &fqMi, &ftmpq); in fRun_6DOF_GY_KALMAN()1039 Quaternion fqMi; // a priori orientation quaternion in fRun_9DOF_GBY_KALMAN() local1070 fqMi = pthisSV->fqPl; in fRun_9DOF_GBY_KALMAN()[all …]
