Searched refs:fQw6x6 (Results 1 – 2 of 2) sorted by relevance
764 for (j = 0; j < 6; j++) pthisSV->fQw6x6[i][j] = 0.0F; in fRun_6DOF_GY_KALMAN()767 pthisSV->fQw6x6[3][3] = pthisSV->fbErrPl[CHX] * pthisSV->fbErrPl[CHX]; in fRun_6DOF_GY_KALMAN()768 pthisSV->fQw6x6[4][4] = pthisSV->fbErrPl[CHY] * pthisSV->fbErrPl[CHY]; in fRun_6DOF_GY_KALMAN()769 pthisSV->fQw6x6[5][5] = pthisSV->fbErrPl[CHZ] * pthisSV->fbErrPl[CHZ]; in fRun_6DOF_GY_KALMAN()772 pthisSV->fQw6x6[0][0] = pthisSV->fqgErrPl[CHX] * in fRun_6DOF_GY_KALMAN()776 pthisSV->fQw6x6[3][3]; in fRun_6DOF_GY_KALMAN()777 pthisSV->fQw6x6[1][1] = pthisSV->fqgErrPl[CHY] * in fRun_6DOF_GY_KALMAN()781 pthisSV->fQw6x6[4][4]; in fRun_6DOF_GY_KALMAN()782 pthisSV->fQw6x6[2][2] = pthisSV->fqgErrPl[CHZ] * in fRun_6DOF_GY_KALMAN()786 pthisSV->fQw6x6[5][5]; in fRun_6DOF_GY_KALMAN()[all …]
372 float fQw6x6[6][6]; ///< covariance matrix Qw member
