void CurieIMUClass::setGyroOffset(int axis, int offset) { if (axis == X_AXIS) { setXGyroOffset(axis); } else if (axis == Y_AXIS) { setYGyroOffset(axis); } else if (axis == Z_AXIS) { setZGyroOffset(axis); } }
void CurieIMUClass::setGyroOffset(int axis, float offset) { int bmiOffset = offset / 0.061; if (bmiOffset < -512) { bmiOffset = -512; } else if (bmiOffset > 511) { bmiOffset = 511; } if (axis == X_AXIS) { setXGyroOffset(bmiOffset); } else if (axis == Y_AXIS) { setYGyroOffset(bmiOffset); } else if (axis == Z_AXIS) { setZGyroOffset(bmiOffset); } setGyroOffsetEnabled(true); }