Home
last modified time | relevance | path

Searched refs:Gyro (Results 1 – 8 of 8) sorted by relevance

/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/
Dhal_frdm_fxs_mult2_b.c77 void ApplyGyroHAL(struct GyroSensor *Gyro) in ApplyGyroHAL() argument
82 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()
Ddriver_FXAS21002.c189 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 …]
Dsensor_fusion.c96 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 …]
Dsensor_fusion.h254 struct GyroSensor Gyro; member
494 struct GyroSensor Gyro; ///< gyro storage member
602 …struct GyroSensor *Gyro ///< pointer to gyroscope logical sensor
Doutput_stream.c284 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()
/hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/driverexamples/demos/
Dorientaion_application_baremetal_agm01.c345 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()
Dorientaion_application_baremetal_agm04.c344 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()
Dorientaion_application_baremetal_agmp03.c343 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()