Searched refs:Gyro (Results 1 – 8 of 8) sorted by relevance
77 void ApplyGyroHAL(struct GyroSensor *Gyro) in ApplyGyroHAL() argument82 for (i = 0; i < Gyro->iFIFOCount; i++) in ApplyGyroHAL()86 int16 itmp16 = Gyro->iYsFIFO[i][CHX]; in ApplyGyroHAL()87 Gyro->iYsFIFO[i][CHX] = -Gyro->iYsFIFO[i][CHY]; in ApplyGyroHAL()88 Gyro->iYsFIFO[i][CHY] = -itmp16; in ApplyGyroHAL()89 Gyro->iYsFIFO[i][CHZ] = -Gyro->iYsFIFO[i][CHZ]; in ApplyGyroHAL()92 Gyro->iYsFIFO[i][CHX] = -Gyro->iYsFIFO[i][CHX]; in ApplyGyroHAL()93 Gyro->iYsFIFO[i][CHY] = -Gyro->iYsFIFO[i][CHY]; in ApplyGyroHAL()96 Gyro->iYsFIFO[i][CHX] = -Gyro->iYsFIFO[i][CHX]; in ApplyGyroHAL()97 Gyro->iYsFIFO[i][CHY] = -Gyro->iYsFIFO[i][CHY]; in ApplyGyroHAL()
189 sfg->Gyro.iWhoAmI = reg; in FXAS21002_Init()203 switch (sfg->Gyro.iWhoAmI) { in FXAS21002_Init()208 sfg->Gyro.iCountsPerDegPerSec = FXAS21000_COUNTSPERDEGPERSEC; in FXAS21002_Init()209 sfg->Gyro.fDegPerSecPerCount = 1.0F / FXAS21000_COUNTSPERDEGPERSEC; in FXAS21002_Init()214 sfg->Gyro.iCountsPerDegPerSec = FXAS21002_COUNTSPERDEGPERSEC; in FXAS21002_Init()215 sfg->Gyro.fDegPerSecPerCount = 1.0F / FXAS21002_COUNTSPERDEGPERSEC; in FXAS21002_Init()218 sfg->Gyro.iFIFOCount=0; in FXAS21002_Init()220 sfg->Gyro.isEnabled = true; in FXAS21002_Init()255 if (sfg->Gyro.iWhoAmI == FXAS21002_WHO_AM_I_WHOAMI_OLD_VALUE) in FXAS21002_Read()273 addToFifo((union FifoSensor*) &(sfg->Gyro), GYRO_FIFO_SIZE, sample); in FXAS21002_Read()[all …]
96 sfg->Gyro.iWhoAmI = 0; in initSensorFusionGlobals()239 if (sfg->Gyro.iFIFOExceeded > 0) { in processGyroData()243 ApplyGyroHAL(&(sfg->Gyro)); // This function is board-dependent in processGyroData()250 for (i = 0; i < sfg->Gyro.iFIFOCount; i++) in processGyroData()252 iSum[j] += sfg->Gyro.iYsFIFO[i][j]; in processGyroData()253 if (sfg->Gyro.iFIFOCount > 0) in processGyroData()257 sfg->Gyro.iYs[j] = (int16)(iSum[j] / (int32) sfg->Gyro.iFIFOCount); in processGyroData()258 sfg->Gyro.fYs[j] = (float)sfg->Gyro.iYs[j] * sfg->Gyro.fDegPerSecPerCount; in processGyroData()306 if (sfg->Gyro.isEnabled) processGyroData(sfg); in conditionSensorReadings()367 sfg->Gyro.iFIFOCount=0; in clearFIFOs()[all …]
254 struct GyroSensor Gyro; member494 struct GyroSensor Gyro; ///< gyro storage member602 …struct GyroSensor *Gyro ///< pointer to gyroscope logical sensor
284 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHX] * 20) / sfg->Gyro.iCountsPerDegPerSec); in CreateAndSendPackets()286 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in CreateAndSendPackets()288 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in CreateAndSendPackets()
345 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHX] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()347 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()349 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()
344 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHX] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()346 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()348 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()
343 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHX] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()345 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHY] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()347 scratch16 = (int16_t) ((sfg->Gyro.iYs[CHZ] * 20) / sfg->Gyro.iCountsPerDegPerSec); in encodeOrientPacketStream()