void ITG3200::readGyro(float *_GyroX, float *_GyroY, float *_GyroZ){
int x, y, z;
readGyroRawCal(&x, &y, &z); // x,y,z will contain calibrated integer values from the sensor
*_GyroX = x / scalefactor[0];
*_GyroY = y / scalefactor[1];
*_GyroZ = z / scalefactor[2];
}
void ITG3200::readGyro(float *_GyroX, float *_GyroY, float *_GyroZ){
short x, y, z;
readGyroRawCal(&x, &y, &z); // x,y,z will contain calibrated integer values from the sensor
*_GyroX = x / 14.375 * polarities[0] * gains[0];
*_GyroY = y / 14.375 * polarities[1] * gains[1];
*_GyroZ = z / 14.375 * polarities[2] * gains[2];
}
int ITG3200::readGyro(float *_GyroX, float *_GyroY, float *_GyroZ){
int a=0;
int x, y, z;
a=readGyroRawCal(&x, &y, &z); // x,y,z will contain calibrated integer values from the sensor
MYASSERT(a,"Failed to read from readgyro\n\r")
*_GyroX = x / 14.375 * polarities[0] * gains[0];
*_GyroY = y / 14.375 * polarities[1] * gains[1];
*_GyroZ = z / 14.375 * polarities[2] * gains[2];
return 0;
}
int ITG3200::readGyroRawCal(int *_GyroXYZ) {
int a=0;
a=readGyroRawCal(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
MYASSERT(a,"Failed to read from readgyrorawcal\n\r")
return 0;
}
void ITG3200::readGyroRawCal(short *_GyroXYZ) {
readGyroRawCal(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
void L3G4200D::readGyroRawCal(int *_GyroXYZ) {
readGyroRawCal(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
void ITG3200::readGyroRawCal(int16_t *_GyroXYZ) {
readGyroRawCal(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
void SAT_Gyro::readGyroRawCal(int *_GyroXYZ) {
readGyroRawCal(_GyroXYZ, _GyroXYZ+1, _GyroXYZ+2);
}
