Searched refs:CHZ (Results 1 – 18 of 18) sorted by relevance
54 fmodGyz = fGc[CHY] * fGc[CHY] + fGc[CHZ] * fGc[CHZ]; in f3DOFTiltNED()71 fR[CHX][CHZ] = 1.0F; in f3DOFTiltNED()72 fR[CHZ][CHX] = -1.0F; in f3DOFTiltNED()76 fR[CHX][CHZ] = -1.0F; in f3DOFTiltNED()77 fR[CHZ][CHX] = 1.0F; in f3DOFTiltNED()89 for (i = CHX; i <= CHZ; i++) in f3DOFTiltNED()91 fR[i][CHZ] = fGc[i] * frecipmodGxyz; 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()[all …]
40 for (i = CHX; i <= CHZ; i++) pthisAccelCal->fV[i] = *(pFlash++); in fInitializeAccelCalibration()41 for (i = CHX; i <= CHZ; i++) in fInitializeAccelCalibration()42 for (j = CHX; j <= CHZ; j++) in fInitializeAccelCalibration()44 for (i = CHX; i <= CHZ; i++) in fInitializeAccelCalibration()45 for (j = CHX; j <= CHZ; j++) in fInitializeAccelCalibration()53 pthisAccelCal->fV[CHX] = pthisAccelCal->fV[CHY] = pthisAccelCal->fV[CHZ] = 0.0F; in fInitializeAccelCalibration()78 for (i = CHX; i <= CHZ; i++) pthisAccelBuffer->fSumGs[i] = 0.0F; in fUpdateAccelBuffer()84 for (i = CHX; i <= CHZ; i++) in fUpdateAccelBuffer()93 for (i = CHX; i <= CHZ; i++) in fUpdateAccelBuffer()126 for (i = CHX; i <= CHZ; i++) in fInvertAccelCal()[all …]
299 for (i = CHX; i <= CHZ; i++) in fInit_6DOF_GY_KALMAN()312 for (i = CHX; i <= CHZ; i++) pthisSV->fbPl[i] = *(pFlash++); in fInit_6DOF_GY_KALMAN()318 for (i = CHX; i <= CHZ; i++) in fInit_6DOF_GY_KALMAN()364 for (i = CHX; i <= CHZ; i++) { in fInit_9DOF_GBY_KALMAN()378 for (i = CHX; i <= CHZ; i++) in fInit_9DOF_GBY_KALMAN()383 for (i = CHX; i <= CHZ; i++) { in fInit_9DOF_GBY_KALMAN()552 for (i = CHX; i <= CHZ; i++) pthisSV->fOmega[i] = pthisGyro->fYs[i]; in fRun_3DOF_Y_BASIC()669 for (i = CHX; i <= CHZ; i++) in fRun_6DOF_GY_KALMAN()686 for (i = CHX; i <= CHZ; i++) in fRun_6DOF_GY_KALMAN()708 pthisAccel->fGc[CHZ] * pthisAccel->fGc[CHZ])); in fRun_6DOF_GY_KALMAN()[all …]
198 A[CHZ][CHZ] - in f3x3matrixDetA()199 A[CHY][CHZ] * in f3x3matrixDetA()200 A[CHZ][CHY] in f3x3matrixDetA()203 (A[CHY][CHZ] * A[CHZ][CHX] - A[CHY][CHX] * A[CHZ][CHZ]) + in f3x3matrixDetA()204 A[CHX][CHZ] * in f3x3matrixDetA()205 (A[CHY][CHX] * A[CHZ][CHY] - A[CHY][CHY] * A[CHZ][CHX]) in f3x3matrixDetA()811 fR[CHX][CHZ] * in fveqRu()812 fu[CHZ]; in fveqRu()817 fR[CHY][CHZ] * in fveqRu()818 fu[CHZ]; in fveqRu()[all …]
52 for (i = CHX; i <= CHZ; i++) pthisMagCal->fV[i] = *(pFlash++); in fInitializeMagCalibration()53 for (i = CHX; i <= CHZ; i++) in fInitializeMagCalibration()54 for (j = CHX; j <= CHZ; j++) in fInitializeMagCalibration()66 pthisMagCal->fV[CHX] = pthisMagCal->fV[CHY] = pthisMagCal->fV[CHZ] = 0.0F; in fInitializeMagCalibration()106 if (pthisMag->iBc[CHZ] == 0) return; in iUpdateMagBuffer()107 itanj = (100 * (int32) pthisMag->iBc[CHX]) / ((int32) pthisMag->iBc[CHZ]); in iUpdateMagBuffer()108 itank = (100 * (int32) pthisMag->iBc[CHY]) / ((int32) pthisMag->iBc[CHZ]); in iUpdateMagBuffer()126 for (i = CHX; i <= CHZ; i++) in iUpdateMagBuffer()141 for (i = CHX; i <= CHZ; i++) in iUpdateMagBuffer()182 for (i = CHX; i <= CHZ; i++) in iUpdateMagBuffer()[all …]
88 iOmega[CHZ] = (int16_t) (data->fOmega[CHZ] * 20.0F); in readCommon()222 scratch32 = (sfg->Accel.iGc[CHZ] * 8192) / sfg->Accel.iCountsPerg; in CreateAndSendPackets()254 scratch16 = (int16_t) ((sfg->Mag.iBc[CHZ] * 10) / sfg->Mag.iCountsPeruT); in CreateAndSendPackets()288 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in CreateAndSendPackets()311 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in CreateAndSendPackets()470 sBufAppendItem(sUARTOutputBuffer, &iIndex, (uint8_t *) &iOmega[CHZ], 2); in CreateAndSendPackets()626 scratch16 = (int16_t) (sfg->MagCal.fV[CHZ] * 10.0F); in CreateAndSendPackets()636 scratch16 = (int16_t) (sfg->MagCal.finvW[CHZ][CHZ] * 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()[all …]
40 Accel->iGsFIFO[i][CHZ] = -Accel->iGsFIFO[i][CHZ]; in ApplyAccelHAL()61 Mag->iBsFIFO[i][CHZ] = -Mag->iBsFIFO[i][CHZ]; in ApplyMagHAL()89 Gyro->iYsFIFO[i][CHZ] = -Gyro->iYsFIFO[i][CHZ]; in ApplyGyroHAL()
172 for (j = CHX; j <= CHZ; j++) iSum[j] = 0; in processAccelData()174 for (j = CHX; j <= CHZ; j++) iSum[j] += sfg->Accel.iGsFIFO[i][j]; in processAccelData()177 for (j = CHX; j <= CHZ; j++) in processAccelData()210 for (j = CHX; j <= CHZ; j++) iSum[j] = 0; in processMagData()212 for (j = CHX; j <= CHZ; j++) iSum[j] += sfg->Mag.iBsFIFO[i][j]; in processMagData()215 for (j = CHX; j <= CHZ; j++) in processMagData()249 for (j = CHX; j <= CHZ; j++) iSum[j] = 0; in processGyroData()251 for (j = CHX; j <= CHZ; j++) in processGyroData()255 for (j = CHX; j <= CHZ; j++) in processGyroData()520 if (sample[CHZ] == -32768) sample[CHZ]++; in conditionSample()[all …]
127 sample[CHZ] = (I2C_Buffer[4] << 8) | I2C_Buffer[5]; in MAG3110_Read()130 sample[CHZ] = -sample[CHZ]; // +Z should point up (MAG3110 Z positive is down) in MAG3110_Read()
271 sample[CHZ] = (I2C_Buffer[4] << 8) | I2C_Buffer[5]; in FXAS21002_Read()289 sample[CHZ] = (I2C_Buffer[6*j + 4] << 8) | I2C_Buffer[6*j + 5]; in FXAS21002_Read()
208 sample[CHZ] = (I2C_Buffer[6 * j + 4] << 8) | (I2C_Buffer[6 * j + 5]); // decode Z in FXOS8700_ReadAccData()239 sample[CHZ] = (I2C_Buffer[4] << 8) | I2C_Buffer[5]; in FXOS8700_ReadMagData()
177 sample[CHZ] = (I2C_Buffer[5] << 8) | I2C_Buffer[4]; in FXLS8962_Read()
167 sample[CHZ] = (I2C_Buffer[6 * j + 4] << 8) | I2C_Buffer[6 * j + 5]; in MMA8652_Read()
182 for (i = CHX; i <= CHZ; i++) { in DecodeCommandBytes()
62 #define CHZ 2 ///< Used to access Z-channel entries in various data data structures macro
233 iOmega[CHZ] = (int16_t)(data->fOmega[CHZ] * 20.0F); in readAlgoParams()310 scratch32 = (sfg->Accel.iGc[CHZ] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()331 scratch16 = (int16_t) ((sfg->Mag.iBc[CHZ] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()349 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()362 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
232 iOmega[CHZ] = (int16_t)(data->fOmega[CHZ] * 20.0F); in readAlgoParams()309 scratch32 = (sfg->Accel.iGc[CHZ] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()330 scratch16 = (int16_t) ((sfg->Mag.iBc[CHZ] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()348 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()361 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
231 iOmega[CHZ] = (int16_t)(data->fOmega[CHZ] * 20.0F); in readAlgoParams()308 scratch32 = (sfg->Accel.iGc[CHZ] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()329 scratch16 = (int16_t) ((sfg->Mag.iBc[CHZ] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()347 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()360 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
