Searched refs:ftmp3DOF3x1 (Results 1 – 1 of 1) sorted by relevance
641 float ftmp3DOF3x1[3]; // temporary vector used for 3DOF calculations in fRun_6DOF_GY_KALMAN() local713 ftmp3DOF3x1[CHX] = pthisAccel->fGc[CHX] * ftmp; in fRun_6DOF_GY_KALMAN()714 ftmp3DOF3x1[CHY] = pthisAccel->fGc[CHY] * ftmp; in fRun_6DOF_GY_KALMAN()715 ftmp3DOF3x1[CHZ] = pthisAccel->fGc[CHZ] * ftmp; in fRun_6DOF_GY_KALMAN()720 ftmp3DOF3x1[CHX] = 0.0F; in fRun_6DOF_GY_KALMAN()721 ftmp3DOF3x1[CHY] = 0.0F; in fRun_6DOF_GY_KALMAN()722 ftmp3DOF3x1[CHZ] = 1.0F; in fRun_6DOF_GY_KALMAN()730 ftmp3DOF3x1[CHX] = -ftmp3DOF3x1[CHX]; in fRun_6DOF_GY_KALMAN()731 ftmp3DOF3x1[CHY] = -ftmp3DOF3x1[CHY]; in fRun_6DOF_GY_KALMAN()732 ftmp3DOF3x1[CHZ] = -ftmp3DOF3x1[CHZ]; in fRun_6DOF_GY_KALMAN()[all …]