Searched refs:ftmpA3x3 (Results 1 – 1 of 1) sorted by relevance
642 float ftmpA3x3[3][3]; // scratch 3x3 matrix in fRun_6DOF_GY_KALMAN() local848 ftmpA3x3[i][j] = pthisSV->fQv; in fRun_6DOF_GY_KALMAN()850 ftmpA3x3[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()864 ftmpA3x3[i][j] += pthisSV->fQwCT6x3[k][j]; in fRun_6DOF_GY_KALMAN()866 ftmpA3x3[i][j] += fC3x6ik * pthisSV->fQwCT6x3[k][j]; in fRun_6DOF_GY_KALMAN()873 ftmpA3x3[1][0] = ftmpA3x3[0][1]; in fRun_6DOF_GY_KALMAN()874 ftmpA3x3[2][0] = ftmpA3x3[0][2]; in fRun_6DOF_GY_KALMAN()875 ftmpA3x3[2][1] = ftmpA3x3[1][2]; in fRun_6DOF_GY_KALMAN()878 for (i = 0; i < 3; i++) pfRows[i] = ftmpA3x3[i]; in fRun_6DOF_GY_KALMAN()893 (ftmpA3x3[k][j] != 0.0F)) in fRun_6DOF_GY_KALMAN()[all …]
