Searched refs:ftmpA3x1 (Results 1 – 1 of 1) sorted by relevance
1034 float ftmpA3x1[3]; // scratch 3x1 vector in fRun_9DOF_GBY_KALMAN() local1078 …for (i = CHX; i <= CHZ; i++) ftmpA3x1[i] = (float)pthisGyro->iYsFIFO[j][i] * pthisGyro->fDegPerSec… in fRun_9DOF_GBY_KALMAN()1080 fQuaternionFromRotationVectorDeg(&ftmpq, ftmpA3x1, ftmp); in fRun_9DOF_GBY_KALMAN()1133 ftmpA3x1[CHX] = fR6DOF[CHX][CHZ]; in fRun_9DOF_GBY_KALMAN()1134 ftmpA3x1[CHY] = fR6DOF[CHY][CHZ]; in fRun_9DOF_GBY_KALMAN()1135 ftmpA3x1[CHZ] = fR6DOF[CHZ][CHZ]; in fRun_9DOF_GBY_KALMAN()1140 ftmpA3x1[CHX] = -fR6DOF[CHX][CHZ]; in fRun_9DOF_GBY_KALMAN()1141 ftmpA3x1[CHY] = -fR6DOF[CHY][CHZ]; in fRun_9DOF_GBY_KALMAN()1142 ftmpA3x1[CHZ] = -fR6DOF[CHZ][CHZ]; in fRun_9DOF_GBY_KALMAN()1150 fveqconjgquq(&ftmpq, ftmpA3x1, fgMi); in fRun_9DOF_GBY_KALMAN()[all …]
