diff --git a/src/bmi088.cpp b/src/bmi088.cpp index d17a5c1..b5c2689 100644 --- a/src/bmi088.cpp +++ b/src/bmi088.cpp @@ -17,9 +17,17 @@ namespace sta busRead(GYROSCOPE, BMI088_REG_GYRO_CHIP_ID, &id); if(id != BMI088_GYRO_CHIP_ID) return false; + setGyroscopeRange(GyroRange::ONETHOUSAND); + setGyroscopeBandwidth(GyroBandwidth::TWOHUNDRED_SIXTYFOUR); + setGyroscopeMode(GyroMode::NORMAL_AWAKE); + busRead(ACCELEROMETER, BMI088_REG_ACC_CHIP_ID, &id); if(id != BMI088_ACC_CHIP_ID) return false; + setAccelerometerRange(AccelRange::TWENTYFOURG); + setAccelerometerBandwidth(AccelBandwidth::NORMAL_BANDWIDTH, AccelODR::ONEHUNDRED); + setAccelerometerMode(AccelMode::ON); + return true; }