Home
last modified time | relevance | path

Searched refs:fmatB (Results 1 – 6 of 6) sorted by relevance

/hal_nxp-3.6.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
DprecisionAccelerometer.c376 pthisAccelCal->fmatB, 7); in fComputeAccelCalibration7()
384 det = pthisAccelCal->fmatB[0][j] * in fComputeAccelCalibration7()
385 pthisAccelCal->fmatB[1][j] * in fComputeAccelCalibration7()
386 pthisAccelCal->fmatB[2][j]; in fComputeAccelCalibration7()
391 pthisAccelCal->fmatB[i][j] = -pthisAccelCal->fmatB[i][j]; in fComputeAccelCalibration7()
397 pthisAccelCal->finvW[CHX][CHX] = sqrtf(fabsf(pthisAccelCal->fmatB[0][j])); in fComputeAccelCalibration7()
398 pthisAccelCal->finvW[CHY][CHY] = sqrtf(fabsf(pthisAccelCal->fmatB[1][j])); in fComputeAccelCalibration7()
399 pthisAccelCal->finvW[CHZ][CHZ] = sqrtf(fabsf(pthisAccelCal->fmatB[2][j])); in fComputeAccelCalibration7()
401 pthisAccelCal->fmatB[3][j] / in fComputeAccelCalibration7()
402 pthisAccelCal->fmatB[0][j]; in fComputeAccelCalibration7()
[all …]
Dmagnetic.c588 …pthisMagCal->fmatB[i][j] = pthisMagCal->fmatB[j][i] = pthisMagCal->fmatA[i][j] = pthisMagCal->fmat… in fUpdateMagCalibration4Slice()
592 for (i = 0; i < 4; i++) pfRows[i] = pthisMagCal->fmatB[i]; in fUpdateMagCalibration4Slice()
612 pthisMagCal->fvecB[i] = pthisMagCal->fmatB[i][0] * pthisMagCal->fvecA[0]; in fUpdateMagCalibration4Slice()
614 pthisMagCal->fvecB[i] += pthisMagCal->fmatB[i][j] * pthisMagCal->fvecA[j]; in fUpdateMagCalibration4Slice()
802 pthisMagCal->fmatB[i][j] = 0.0F; in fUpdateMagCalibration7Slice()
803 pthisMagCal->fmatB[i][i] = 1.0F; in fUpdateMagCalibration7Slice()
853 fComputeEigSlice(pthisMagCal->fmatA, pthisMagCal->fmatB, in fUpdateMagCalibration7Slice()
894 fdetA = pthisMagCal->fmatB[CHX][imin] * in fUpdateMagCalibration7Slice()
895 pthisMagCal->fmatB[CHY][imin] * in fUpdateMagCalibration7Slice()
896 pthisMagCal->fmatB[CHZ][imin]; in fUpdateMagCalibration7Slice()
[all …]
Dmatrix.c554 void fComputeEigSlice(float fmatA[10][10], float fmatB[10][10], float fvecA[10], in fComputeEigSlice()
596 ftmp = fmatB[k][i]; in fComputeEigSlice()
599 fmatB[k][i] = ftmp - sinphi * (fmatB[k][j] + tanhalfphi * ftmp); in fComputeEigSlice()
602 fmatB[k][j] = fmatB[k][j] + sinphi * (ftmp - tanhalfphi * fmatB[k][j]); in fComputeEigSlice()
Dmatrix.h80 float fmatB[10][10],
DprecisionAccelerometer.h39 float fmatB[10][10]; ///< scratch 10x10 matrix used by calibration algorithms member
Dmagnetic.h73 float fmatB[10][10]; ///< scratch 10x10 float matrix used by calibration algorithms member