Searched refs:fqgErrPl (Results 1 – 3 of 3) sorted by relevance
301 pthisSV->fqgErrPl[i] = 0.0F; in fInit_6DOF_GY_KALMAN()365 pthisSV->fqgErrPl[i] = 0.0F; in fInit_9DOF_GBY_KALMAN()772 pthisSV->fQw6x6[0][0] = pthisSV->fqgErrPl[CHX] * in fRun_6DOF_GY_KALMAN()773 pthisSV->fqgErrPl[CHX] + in fRun_6DOF_GY_KALMAN()777 pthisSV->fQw6x6[1][1] = pthisSV->fqgErrPl[CHY] * in fRun_6DOF_GY_KALMAN()778 pthisSV->fqgErrPl[CHY] + in fRun_6DOF_GY_KALMAN()782 pthisSV->fQw6x6[2][2] = pthisSV->fqgErrPl[CHZ] * in fRun_6DOF_GY_KALMAN()783 pthisSV->fqgErrPl[CHZ] + in fRun_6DOF_GY_KALMAN()794 pthisSV->fQw6x6[0][3] = pthisSV->fQw6x6[3][0] = pthisSV->fqgErrPl[CHX] * in fRun_6DOF_GY_KALMAN()798 pthisSV->fQw6x6[1][4] = pthisSV->fQw6x6[4][1] = pthisSV->fqgErrPl[CHY] * in fRun_6DOF_GY_KALMAN()[all …]
377 float fqgErrPl[3]; ///< gravity vector tilt orientation quaternion error (dimensionless) member414 float fqgErrPl[3]; ///< gravity vector tilt orientation quaternion error (dimensionless) member
732 … if (six_axis_kalman) scratch16 = (int16_t) (sfg->SV_6DOF_GY_KALMAN.fqgErrPl[i] * 30000.0F); in CreateAndSendPackets()735 … if (nine_axis_kalman) scratch16 = (int16_t) (sfg->SV_9DOF_GBY_KALMAN.fqgErrPl[i] * 30000.0F); in CreateAndSendPackets()
