Esempio n. 1
0
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;
  }
Esempio n. 2
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);
}
Esempio n. 3
0
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);
}
Esempio n. 4
0
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;
  }
Esempio n. 5
0
int ITG3200::readGyroRaw(int *_GyroXYZ){
  int a=0;
  a=readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
  return a;
}
Esempio n. 6
0
void ITG3200::readGyroRawCal(short *_GyroX, short *_GyroY, short *_GyroZ) {
  readGyroRaw(_GyroX, _GyroY, _GyroZ);
  *_GyroX += offsets[0];
  *_GyroY += offsets[1];
  *_GyroZ += offsets[2];
}
Esempio n. 7
0
void ITG3200::readGyroRaw(short *_GyroXYZ){
  readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
Esempio n. 8
0
void L3G4200D::readGyroRaw(int *_GyroXYZ){
  readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
Esempio n. 9
0
void L3G4200D::readGyroRawCal(int *_GyroX, int *_GyroY, int *_GyroZ) {
  readGyroRaw(_GyroX, _GyroY, _GyroZ);
  *_GyroX += offsets[0];
  *_GyroY += offsets[1];
  *_GyroZ += offsets[2];
}
Esempio n. 10
0
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];
}
Esempio n. 11
0
void ITG3200::readGyroRaw(int16_t *_GyroXYZ) {
    readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
Esempio n. 12
0
void SAT_Gyro::readGyroRaw( int *_GyroXYZ){
  readGyroRaw(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}