int ITG3200::readGyroRawCal(int *_GyroX, int *_GyroY, int *_GyroZ) { int a=0; a=readGyroRaw(_GyroX, _GyroY, _GyroZ); MYASSERT(a,"Failed to get gyro data readgyrorawcal\n\r") *_GyroX += offsets[0]; *_GyroY += offsets[1]; *_GyroZ += offsets[2]; return 0; }
void ITG3200::zeroCalibrate(unsigned int totSamples, unsigned int sampleDelayMS) { short xyz[3]; float tmpOffsets[] = {0,0,0}; for (int i = 0;i < totSamples;i++){ delay(sampleDelayMS); readGyroRaw(xyz); tmpOffsets[0] += xyz[0]; tmpOffsets[1] += xyz[1]; tmpOffsets[2] += xyz[2]; } setOffsets(-tmpOffsets[0] / totSamples, -tmpOffsets[1] / totSamples, -tmpOffsets[2] / totSamples); }
void SAT_Gyro::zeroCalibrate(unsigned int totSamples, unsigned int sampleDelayMS) { float tmpOffsets[] = {0,0,0}; int xyz[3]; for (int i = 0;i < totSamples;i++){ delay(sampleDelayMS); readGyroRaw(xyz); tmpOffsets[0] += xyz[0]; tmpOffsets[1] += xyz[1]; tmpOffsets[2] += xyz[2]; } setOffsets(-tmpOffsets[0] / totSamples + 0.5, -tmpOffsets[1] / totSamples + 0.5, -tmpOffsets[2] / totSamples + 0.5); }
int ITG3200::zeroCalibrate(unsigned int totSamples, unsigned int sampleDelayMS) { int a=0; int xyz[3]; float tmpOffsets[] = {0,0,0}; for (int i = 0;i < totSamples;i++){ ms_delay(sampleDelayMS); a=readGyroRaw(xyz); if(a<0){ return -1; } //MYASSERT(a,"Failed to read sensor data for offset\n\r") tmpOffsets[0] += xyz[0]; tmpOffsets[1] += xyz[1]; tmpOffsets[2] += xyz[2]; } setOffsets(-tmpOffsets[0] / totSamples+0.5, -tmpOffsets[1] / totSamples+0.5, -tmpOffsets[2] / totSamples+0.5); return 0; }
int ITG3200::readGyroRaw(int *_GyroXYZ){ int a=0; a=readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2); return a; }
void ITG3200::readGyroRawCal(short *_GyroX, short *_GyroY, short *_GyroZ) { readGyroRaw(_GyroX, _GyroY, _GyroZ); *_GyroX += offsets[0]; *_GyroY += offsets[1]; *_GyroZ += offsets[2]; }
void ITG3200::readGyroRaw(short *_GyroXYZ){ readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2); }
void L3G4200D::readGyroRaw(int *_GyroXYZ){ readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2); }
void L3G4200D::readGyroRawCal(int *_GyroX, int *_GyroY, int *_GyroZ) { readGyroRaw(_GyroX, _GyroY, _GyroZ); *_GyroX += offsets[0]; *_GyroY += offsets[1]; *_GyroZ += offsets[2]; }
void ITG3200::readGyroRawCal(int16_t *_GyroX, int16_t *_GyroY, int16_t *_GyroZ) { readGyroRaw(_GyroX, _GyroY, _GyroZ); *_GyroX += offsets[0]; *_GyroY += offsets[1]; *_GyroZ += offsets[2]; }
void ITG3200::readGyroRaw(int16_t *_GyroXYZ) { readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2); }
void SAT_Gyro::readGyroRaw( int *_GyroXYZ){ readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2); }