Home
last modified time | relevance | path

Searched refs:finvW (Results 1 – 5 of 5) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
DprecisionAccelerometer.c43 pthisAccelCal->finvW[i][j] = *(pFlash++); in fInitializeAccelCalibration()
54 f3x3matrixAeqI(pthisAccelCal->finvW); in fInitializeAccelCalibration()
132 pthisAccel->fGc[i] = pthisAccelCal->finvW[i][CHX] * in fInvertAccelCal()
134 pthisAccelCal->finvW[i][CHY] * in fInvertAccelCal()
136 pthisAccelCal->finvW[i][CHZ] * in fInvertAccelCal()
196 fVeq3x3AxV(fGc0, pthisAccelCal->finvW); in fRunAccelCalibration()
321 pthisAccelCal->finvW[CHX][CHY] = pthisAccelCal->finvW[CHY][CHX] = 0.0F; in fComputeAccelCalibration4()
322 pthisAccelCal->finvW[CHX][CHZ] = pthisAccelCal->finvW[CHZ][CHX] = 0.0F; in fComputeAccelCalibration4()
323 pthisAccelCal->finvW[CHY][CHZ] = pthisAccelCal->finvW[CHZ][CHY] = 0.0F; in fComputeAccelCalibration4()
324 …pthisAccelCal->finvW[CHX][CHX] = pthisAccelCal->finvW[CHY][CHY] = pthisAccelCal->finvW[CHZ][CHZ] =… in fComputeAccelCalibration4()
[all …]
Doutput_stream.c632 scratch16 = (int16_t) (sfg->MagCal.finvW[CHX][CHX] * 1000.0F); in CreateAndSendPackets()
634 scratch16 = (int16_t) (sfg->MagCal.finvW[CHY][CHY] * 1000.0F); in CreateAndSendPackets()
636 scratch16 = (int16_t) (sfg->MagCal.finvW[CHZ][CHZ] * 1000.0F); in CreateAndSendPackets()
642 scratch16 = (int16_t) (sfg->MagCal.finvW[CHX][CHY] * 1000.0F); in CreateAndSendPackets()
644 scratch16 = (int16_t) (sfg->MagCal.finvW[CHX][CHZ] * 1000.0F); in CreateAndSendPackets()
646 scratch16 = (int16_t) (sfg->MagCal.finvW[CHY][CHZ] * 1000.0F); in CreateAndSendPackets()
884 scratch16 = (int16_t) ((sfg->AccelCal.finvW[CHX][CHX] - 1.0F) * 10000.0F); in CreateAndSendPackets()
886 scratch16 = (int16_t) ((sfg->AccelCal.finvW[CHY][CHY] - 1.0F) * 10000.0F); in CreateAndSendPackets()
888 scratch16 = (int16_t) ((sfg->AccelCal.finvW[CHZ][CHZ] - 1.0F) * 10000.0F); in CreateAndSendPackets()
892 scratch16 = (int16_t) (sfg->AccelCal.finvW[CHX][CHY] * 10000.0F); in CreateAndSendPackets()
[all …]
DprecisionAccelerometer.h35 float finvW[3][3]; ///< inverse gain matrix member
Dmagnetic.h59 float finvW[3][3]; ///< current inverse soft iron matrix member
Dmagnetic.c55 pthisMagCal->finvW[i][j] = *(pFlash++); in fInitializeMagCalibration()
67 f3x3matrixAeqI(pthisMagCal->finvW); in fInitializeMagCalibration()
300 pthisMag->fBc[i] = pthisMagCal->finvW[i][CHX] * in fInvertMagCal()
302 pthisMagCal->finvW[i][CHY] * in fInvertMagCal()
304 pthisMagCal->finvW[i][CHZ] * in fInvertMagCal()
414 pthisMagCal->finvW[i][j] = pthisMagCal->ftrinvW[i][j]; in fRunMagCalibration()