Searched refs:CHY (Results 1 – 17 of 17) sorted by relevance
54 fmodGyz = fGc[CHY] * fGc[CHY] + fGc[CHZ] * fGc[CHZ]; in f3DOFTiltNED()68 fR[CHY][CHY] = 1.0F; in f3DOFTiltNED()96 fR[CHY][CHX] = -fR[CHX][CHZ] * fR[CHY][CHZ] * ftmp; in f3DOFTiltNED()100 fR[CHX][CHY] = 0.0F; in f3DOFTiltNED()101 fR[CHY][CHY] = fR[CHZ][CHZ] * ftmp; in f3DOFTiltNED()102 fR[CHZ][CHY] = -fR[CHY][CHZ] * ftmp; in f3DOFTiltNED()134 fmodGxyz = fmodGxz + fGc[CHY] * fGc[CHY]; in f3DOFTiltWin8()148 if (fGc[CHY] >= 0.0F) in f3DOFTiltWin8()150 fR[CHY][CHZ] = -1.0F; in f3DOFTiltWin8()151 fR[CHZ][CHY] = 1.0F; in f3DOFTiltWin8()[all …]
53 pthisAccelCal->fV[CHX] = pthisAccelCal->fV[CHY] = pthisAccelCal->fV[CHZ] = 0.0F; in fInitializeAccelCalibration()134 pthisAccelCal->finvW[i][CHY] * in fInvertAccelCal()135 ftmp[CHY] + in fInvertAccelCal()146 pthisAccelCal->fR0[CHY][i] * in fInvertAccelCal()147 ftmp[CHY] + in fInvertAccelCal()248 pthisAccelBuffer->fGsStored[i][CHY] * in fComputeAccelCalibration4()249 pthisAccelBuffer->fGsStored[i][CHY] + in fComputeAccelCalibration4()253 pthisAccelCal->fvecA[1] += pthisAccelBuffer->fGsStored[i][CHY] * ftmp; in fComputeAccelCalibration4()261 pthisAccelCal->fmatA[CHX][CHY] += pthisAccelBuffer->fGsStored[i][ in fComputeAccelCalibration4()263 pthisAccelBuffer->fGsStored[i][CHY]; in fComputeAccelCalibration4()[all …]
32 Accel->iGsFIFO[i][CHX] = Accel->iGsFIFO[i][CHY]; in ApplyAccelHAL()33 Accel->iGsFIFO[i][CHY] = itmp16; in ApplyAccelHAL()37 Accel->iGsFIFO[i][CHY] = -Accel->iGsFIFO[i][CHY]; in ApplyAccelHAL()59 Mag->iBsFIFO[i][CHX] = -Mag->iBsFIFO[i][CHY]; in ApplyMagHAL()60 Mag->iBsFIFO[i][CHY] = -itmp16; in ApplyMagHAL()65 Mag->iBsFIFO[i][CHY] = -Mag->iBsFIFO[i][CHY]; in ApplyMagHAL()69 Mag->iBsFIFO[i][CHY] = -Mag->iBsFIFO[i][CHY]; in ApplyMagHAL()87 Gyro->iYsFIFO[i][CHX] = -Gyro->iYsFIFO[i][CHY]; in ApplyGyroHAL()88 Gyro->iYsFIFO[i][CHY] = -itmp16; in ApplyGyroHAL()93 Gyro->iYsFIFO[i][CHY] = -Gyro->iYsFIFO[i][CHY]; in ApplyGyroHAL()[all …]
197 A[CHY][CHY] * in f3x3matrixDetA()199 A[CHY][CHZ] * in f3x3matrixDetA()200 A[CHZ][CHY] in f3x3matrixDetA()202 A[CHX][CHY] * in f3x3matrixDetA()203 (A[CHY][CHZ] * A[CHZ][CHX] - A[CHY][CHX] * A[CHZ][CHZ]) + in f3x3matrixDetA()205 (A[CHY][CHX] * A[CHZ][CHY] - A[CHY][CHY] * A[CHZ][CHX]) in f3x3matrixDetA()809 fR[CHX][CHY] * in fveqRu()810 fu[CHY] + in fveqRu()813 fv[CHY] = fR[CHY][CHX] * in fveqRu()815 fR[CHY][CHY] * in fveqRu()[all …]
707 pthisAccel->fGc[CHY] * pthisAccel->fGc[CHY] + in fRun_6DOF_GY_KALMAN()714 ftmp3DOF3x1[CHY] = pthisAccel->fGc[CHY] * ftmp; in fRun_6DOF_GY_KALMAN()721 ftmp3DOF3x1[CHY] = 0.0F; in fRun_6DOF_GY_KALMAN()731 ftmp3DOF3x1[CHY] = -ftmp3DOF3x1[CHY]; in fRun_6DOF_GY_KALMAN()739 ftmpMi3x1[CHY] = 2.0F * (fqMi.q2 * fqMi.q3 + fqMi.q0 * fqMi.q1); in fRun_6DOF_GY_KALMAN()748 ftmpMi3x1[CHY] = -ftmpMi3x1[CHY]; in fRun_6DOF_GY_KALMAN()756 pthisSV->fZErr[CHY] = ftmpq.q2; in fRun_6DOF_GY_KALMAN()768 pthisSV->fQw6x6[4][4] = pthisSV->fbErrPl[CHY] * pthisSV->fbErrPl[CHY]; in fRun_6DOF_GY_KALMAN()777 pthisSV->fQw6x6[1][1] = pthisSV->fqgErrPl[CHY] * in fRun_6DOF_GY_KALMAN()778 pthisSV->fqgErrPl[CHY] + in fRun_6DOF_GY_KALMAN()[all …]
87 iOmega[CHY] = (int16_t) (data->fOmega[CHY] * 20.0F); in readCommon()216 scratch32 = (sfg->Accel.iGc[CHY] * 8192) / sfg->Accel.iCountsPerg; in CreateAndSendPackets()252 scratch16 = (int16_t) ((sfg->Mag.iBc[CHY] * 10) / sfg->Mag.iCountsPeruT); in CreateAndSendPackets()286 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in CreateAndSendPackets()311 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in CreateAndSendPackets()469 sBufAppendItem(sUARTOutputBuffer, &iIndex, (uint8_t *) &iOmega[CHY], 2); in CreateAndSendPackets()624 scratch16 = (int16_t) (sfg->MagCal.fV[CHY] * 10.0F); in CreateAndSendPackets()634 scratch16 = (int16_t) (sfg->MagCal.finvW[CHY][CHY] * 1000.0F); in CreateAndSendPackets()642 scratch16 = (int16_t) (sfg->MagCal.finvW[CHX][CHY] * 1000.0F); in CreateAndSendPackets()646 scratch16 = (int16_t) (sfg->MagCal.finvW[CHY][CHZ] * 1000.0F); in CreateAndSendPackets()[all …]
66 pthisMagCal->fV[CHX] = pthisMagCal->fV[CHY] = pthisMagCal->fV[CHZ] = 0.0F; in fInitializeMagCalibration()108 itank = (100 * (int32) pthisMag->iBc[CHY]) / ((int32) pthisMag->iBc[CHZ]); in iUpdateMagBuffer()302 pthisMagCal->finvW[i][CHY] * in fInvertMagCal()303 ftmp[CHY] + in fInvertMagCal()554 iBsZeroMean[CHY] * in fUpdateMagCalibration4Slice()555 iBsZeroMean[CHY] + in fUpdateMagCalibration4Slice()895 pthisMagCal->fmatB[CHY][imin] * in fUpdateMagCalibration7Slice()934 pthisMagCal->fA[CHX][CHY] = pthisMagCal->fA[CHX][CHZ] = pthisMagCal->fA[CHY][CHZ] = 0.0F; in fUpdateMagCalibration7Slice()935 …pthisMagCal->ftrinvW[CHX][CHY] = pthisMagCal->ftrinvW[CHX][CHZ] = pthisMagCal->ftrinvW[CHY][CHZ] =… in fUpdateMagCalibration7Slice()1207 pthisMagCal->fA[CHX][CHY] = pthisMagCal->fA[CHY][CHX] = pthisMagCal->fmatB[1][imin]; in fUpdateMagCalibration10Slice()[all …]
270 sample[CHY] = (I2C_Buffer[2] << 8) | I2C_Buffer[3]; in FXAS21002_Read()288 sample[CHY] = (I2C_Buffer[6*j + 2] << 8) | I2C_Buffer[6*j + 3]; in FXAS21002_Read()
207 sample[CHY] = (I2C_Buffer[6 * j + 2] << 8) | (I2C_Buffer[6 * j + 3]); // decode Y in FXOS8700_ReadAccData()238 sample[CHY] = (I2C_Buffer[2] << 8) | I2C_Buffer[3]; in FXOS8700_ReadMagData()
519 if (sample[CHY] == -32768) sample[CHY]++; in conditionSample()533 sensor->Accel.iGsFIFO[fifoCount][CHY] = sample[CHY]; in addToFifo()
126 sample[CHY] = (I2C_Buffer[2] << 8) | I2C_Buffer[3]; in MAG3110_Read()
176 sample[CHY] = (I2C_Buffer[3] << 8) | I2C_Buffer[2]; in FXLS8962_Read()
166 sample[CHY] = (I2C_Buffer[6 * j + 2] << 8) | I2C_Buffer[6 * j + 3]; in MMA8652_Read()
61 #define CHY 1 ///< Used to access Y-channel entries in various data data structures macro
232 iOmega[CHY] = (int16_t)(data->fOmega[CHY] * 20.0F); in readAlgoParams()304 scratch32 = (sfg->Accel.iGc[CHY] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()329 scratch16 = (int16_t) ((sfg->Mag.iBc[CHY] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()347 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()362 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
231 iOmega[CHY] = (int16_t)(data->fOmega[CHY] * 20.0F); in readAlgoParams()303 scratch32 = (sfg->Accel.iGc[CHY] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()328 scratch16 = (int16_t) ((sfg->Mag.iBc[CHY] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()346 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()361 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
230 iOmega[CHY] = (int16_t)(data->fOmega[CHY] * 20.0F); in readAlgoParams()302 scratch32 = (sfg->Accel.iGc[CHY] * 8192) / sfg->Accel.iCountsPerg; in encodeOrientPacketStream()327 scratch16 = (int16_t) ((sfg->Mag.iBc[CHY] * 10) / sfg->Mag.iCountsPeruT); in encodeOrientPacketStream()345 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()360 iOmega[CHX] = iOmega[CHY] = iOmega[CHZ] = 0; in encodeOrientPacketStream()
