Searched refs:ftmpMi3x1 (Results 1 – 1 of 1) sorted by relevance
640 float ftmpMi3x1[3]; // temporary vector used for a priori calculations in fRun_6DOF_GY_KALMAN() local687 ftmpMi3x1[i] = (float) pthisGyro->iYsFIFO[j][i] * in fRun_6DOF_GY_KALMAN()692 fQuaternionFromRotationVectorDeg(&ftmpq, ftmpMi3x1, ftmp); 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()747 ftmpMi3x1[CHX] = -ftmpMi3x1[CHX]; in fRun_6DOF_GY_KALMAN()748 ftmpMi3x1[CHY] = -ftmpMi3x1[CHY]; in fRun_6DOF_GY_KALMAN()749 ftmpMi3x1[CHZ] = -ftmpMi3x1[CHZ]; in fRun_6DOF_GY_KALMAN()754 fveqconjgquq(&ftmpq, ftmp3DOF3x1, ftmpMi3x1); in fRun_6DOF_GY_KALMAN()
