Home
last modified time | relevance | path

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

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
DprecisionAccelerometer.c236 pthisAccelCal->fmatA[i][j] = 0.0F; in fComputeAccelCalibration4()
258 pthisAccelCal->fmatA[CHX][CHX] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
261 pthisAccelCal->fmatA[CHX][CHY] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
264 pthisAccelCal->fmatA[CHX][CHZ] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
267 pthisAccelCal->fmatA[CHX][3] += pthisAccelBuffer->fGsStored[i][CHX]; in fComputeAccelCalibration4()
268 pthisAccelCal->fmatA[CHY][CHY] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
271 pthisAccelCal->fmatA[CHY][CHZ] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
274 pthisAccelCal->fmatA[CHY][3] += pthisAccelBuffer->fGsStored[i][CHY]; in fComputeAccelCalibration4()
275 pthisAccelCal->fmatA[CHZ][CHZ] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()
278 pthisAccelCal->fmatA[CHZ][3] += pthisAccelBuffer->fGsStored[i][CHZ]; in fComputeAccelCalibration4()
[all …]
Dmagnetic.c476 for (j = i; j < 4; j++) pthisMagCal->fmatA[i][j] = 0.0F; in fUpdateMagCalibration4Slice()
542 pthisMagCal->fmatA[0][0] += (float) (iBsZeroMean[0] * iBsZeroMean[0]); in fUpdateMagCalibration4Slice()
543 pthisMagCal->fmatA[0][1] += (float) (iBsZeroMean[0] * iBsZeroMean[1]); in fUpdateMagCalibration4Slice()
544 pthisMagCal->fmatA[0][2] += (float) (iBsZeroMean[0] * iBsZeroMean[2]); in fUpdateMagCalibration4Slice()
545 pthisMagCal->fmatA[1][1] += (float) (iBsZeroMean[1] * iBsZeroMean[1]); in fUpdateMagCalibration4Slice()
546 pthisMagCal->fmatA[1][2] += (float) (iBsZeroMean[1] * iBsZeroMean[2]); in fUpdateMagCalibration4Slice()
547 pthisMagCal->fmatA[2][2] += (float) (iBsZeroMean[2] * iBsZeroMean[2]); in fUpdateMagCalibration4Slice()
579 pthisMagCal->fmatA[3][3] = (float) pthisMagBuffer->iMagBufferCount; in fUpdateMagCalibration4Slice()
588 …gCal->fmatB[i][j] = pthisMagCal->fmatB[j][i] = pthisMagCal->fmatA[i][j] = pthisMagCal->fmatA[j][i]; in fUpdateMagCalibration4Slice()
647 pthisMagCal->fvecA[i] = pthisMagCal->fmatA[i][0] * pthisMagCal->fvecB[0]; in fUpdateMagCalibration4Slice()
[all …]
Dmatrix.c554 void fComputeEigSlice(float fmatA[10][10], float fmatB[10][10], float fvecA[10], in fComputeEigSlice()
566 cot2phi = 0.5F * (fvecA[j] - fvecA[i]) / (fmatA[i][j]); in fComputeEigSlice()
580 ftmp = tanphi * fmatA[i][j]; in fComputeEigSlice()
590 fmatA[i][j] = 0.0F; in fComputeEigSlice()
609 ftmp = fmatA[k][i]; in fComputeEigSlice()
612 fmatA[k][i] = ftmp - sinphi * (fmatA[k][j] + tanhalfphi * ftmp); in fComputeEigSlice()
615 fmatA[k][j] = fmatA[k][j] + sinphi * (ftmp - tanhalfphi * fmatA[k][j]); in fComputeEigSlice()
621 ftmp = fmatA[i][k]; in fComputeEigSlice()
624 fmatA[i][k] = ftmp - sinphi * (fmatA[k][j] + tanhalfphi * ftmp); in fComputeEigSlice()
627 fmatA[k][j] = fmatA[k][j] + sinphi * (ftmp - tanhalfphi * fmatA[k][j]); in fComputeEigSlice()
[all …]
Dmatrix.h79 float fmatA[10][10],
DprecisionAccelerometer.h38 float fmatA[10][10]; ///< scratch 10x10 matrix used by calibration algorithms member
Dmagnetic.h72 float fmatA[10][10]; ///< scratch 10x10 float matrix used by calibration algorithms member