Searched refs:ftmp (Results 1 – 6 of 6) sorted by relevance
| /hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
| D | matrix.c | 155 float ftmp; // determinant and then reciprocal in f3x3matrixAeqInvSymB() local
163 ftmp = B[0][0] * in f3x3matrixAeqInvSymB()
171 if (ftmp != 0.0F) in f3x3matrixAeqInvSymB()
173 ftmp = 1.0F / ftmp; in f3x3matrixAeqInvSymB()
174 A[0][0] = fB11B22mB12B12 * ftmp; in f3x3matrixAeqInvSymB()
175 A[1][0] = A[0][1] = fB12B02mB01B22 * ftmp; in f3x3matrixAeqInvSymB()
176 A[2][0] = A[0][2] = fB01B12mB11B02 * ftmp; in f3x3matrixAeqInvSymB()
177 A[1][1] = (B[0][0] * B[2][2] - B[0][2] * B[0][2]) * ftmp; in f3x3matrixAeqInvSymB()
178 A[2][1] = A[1][2] = (B[0][2] * B[0][1] - B[0][0] * B[1][2]) * ftmp; in f3x3matrixAeqInvSymB()
179 A[2][2] = (B[0][0] * B[1][1] - B[0][1] * B[0][1]) * ftmp; in f3x3matrixAeqInvSymB()
[all …]
|
| D | orientation.c | 51 float ftmp; // scratch variable in f3DOFTiltNED() local
86 ftmp = fmodGxyz / fmodGyz; in f3DOFTiltNED()
96 fR[CHY][CHX] = -fR[CHX][CHZ] * fR[CHY][CHZ] * ftmp; in f3DOFTiltNED()
97 fR[CHZ][CHX] = -fR[CHX][CHZ] * fR[CHZ][CHZ] * ftmp; in f3DOFTiltNED()
101 fR[CHY][CHY] = fR[CHZ][CHZ] * ftmp; in f3DOFTiltNED()
102 fR[CHZ][CHY] = -fR[CHY][CHZ] * ftmp; in f3DOFTiltNED()
129 float ftmp; // scratch variable in f3DOFTiltWin8() local
165 ftmp = fmodGxyz / fmodGxz; in f3DOFTiltWin8()
168 ftmp = -ftmp; in f3DOFTiltWin8()
178 fR[CHX][CHX] = -fR[CHZ][CHZ] * ftmp; in f3DOFTiltWin8()
[all …]
|
| D | fusion.c | 254 float ftmp; in fInit_6DOF_GB_BASIC() local
267 …ompassNED(pthisSV->fLPR, &(pthisSV->fLPDelta), &ftmp, &ftmp, pthisMag->fBc, pthisAccel->fGc, &ftmp… in fInit_6DOF_GB_BASIC()
269 …ssAndroid(pthisSV->fLPR, &(pthisSV->fLPDelta), &ftmp, &ftmp, pthisMag->fBc, pthisAccel->fGc, &ftmp… in fInit_6DOF_GB_BASIC()
271 …mpassWin8(pthisSV->fLPR, &(pthisSV->fLPDelta), &ftmp, &ftmp, pthisMag->fBc, pthisAccel->fGc, &ftmp… in fInit_6DOF_GB_BASIC()
349 float ftmp;// scratch in fInit_9DOF_GBY_KALMAN() local
397 pthisMag->fBc, pthisAccel->fGc, &ftmp, &ftmp); in fInit_9DOF_GBY_KALMAN()
400 pthisMag->fBc, pthisAccel->fGc, &ftmp, &ftmp); in fInit_9DOF_GBY_KALMAN()
403 pthisMag->fBc, pthisAccel->fGc, &ftmp, &ftmp); in fInit_9DOF_GBY_KALMAN()
649 float ftmp; // scratch float in fRun_6DOF_GY_KALMAN() local
680 ftmp = pthisSV->fdeltat / (float) pthisGyro->iFIFOCount; in fRun_6DOF_GY_KALMAN()
[all …]
|
| D | precisionAccelerometer.c | 122 float ftmp[3]; // temporary array in fInvertAccelCal() local
127 ftmp[i] = pthisAccel->fGs[i] - pthisAccelCal->fV[i]; in fInvertAccelCal()
133 ftmp[CHX] + in fInvertAccelCal()
135 ftmp[CHY] + in fInvertAccelCal()
137 ftmp[CHZ]; in fInvertAccelCal()
141 for (i = CHX; i <= CHZ; i++) ftmp[i] = pthisAccel->fGc[i]; in fInvertAccelCal()
145 ftmp[CHX] + in fInvertAccelCal()
147 ftmp[CHY] + in fInvertAccelCal()
149 ftmp[CHZ]; in fInvertAccelCal()
221 float ftmp; // scratch in fComputeAccelCalibration4() local
[all …]
|
| D | magnetic.c | 288 float ftmp[3]; // temporary array in fInvertMagCal() local
294 ftmp[i] = pthisMag->fBs[i] - pthisMagCal->fV[i]; in fInvertMagCal()
301 ftmp[CHX] + in fInvertMagCal()
303 ftmp[CHY] + in fInvertMagCal()
305 ftmp[CHZ]; in fInvertMagCal()
604 float ftmp; // scratch in fUpdateMagCalibration4Slice() local
618 ftmp = 0.5F * pthisMag->fuTPerCount; in fUpdateMagCalibration4Slice()
620 pthisMagCal->ftrV[i] = ftmp * pthisMagCal->fvecB[i]; in fUpdateMagCalibration4Slice()
631 ftmp = pthisMag->fuTPerCount / (float) pthisMagBuffer->iMagBufferCount; in fUpdateMagCalibration4Slice()
633 pthisMagCal->ftrV[i] += (float) pthisMagCal->iSumBs[i] * ftmp; in fUpdateMagCalibration4Slice()
[all …]
|
| D | output_stream.c | 125 float ftmp; // scratch in CreateAndSendPackets() local
795 ftmp = 0.0F; in CreateAndSendPackets()
797 if (six_axis_kalman) ftmp = sfg->SV_6DOF_GY_KALMAN.fAccGl[i] * 8192.0F; in CreateAndSendPackets()
800 if (nine_axis_kalman) ftmp = sfg->SV_9DOF_GBY_KALMAN.fAccGl[i] * 8192.0F; in CreateAndSendPackets()
804 if (ftmp > 32767.0F) scratch16 = 32767; in CreateAndSendPackets()
805 else if (ftmp < -32768.0F) scratch16 = -32768; in CreateAndSendPackets()
806 else scratch16 = (int16_t) ftmp; in CreateAndSendPackets()
816 ftmp = 0.0F; in CreateAndSendPackets()
818 if (nine_axis_kalman) ftmp = sfg->SV_9DOF_GBY_KALMAN.fDisGl[i] * 100.0F; in CreateAndSendPackets()
822 if (ftmp > 32767.0F) scratch16 = 32767; in CreateAndSendPackets()
[all …]
|
