diff --git a/libraries/AP_InertialSensor/AP_InertialSensor_Flymaple.cpp b/libraries/AP_InertialSensor/AP_InertialSensor_Flymaple.cpp index 8cd6bbca2d..c2c2276957 100644 --- a/libraries/AP_InertialSensor/AP_InertialSensor_Flymaple.cpp +++ b/libraries/AP_InertialSensor/AP_InertialSensor_Flymaple.cpp @@ -254,7 +254,7 @@ void AP_InertialSensor_Flymaple::_accumulate(void) // ADXL345 is in the default FIFO bypass mode, so the FIFO is not used uint8_t buffer[6]; uint64_t now = hal.scheduler->micros(); - // This takes about 500us at 200kHz I2C speed + // This takes about 250us at 400kHz I2C speed if ((now - _last_accel_timestamp) >= raw_sample_interval_us && hal.i2c->readRegisters(FLYMAPLE_ACCELEROMETER_ADDRESS, FLYMAPLE_ACCELEROMETER_ADXLREG_DATAX0, 6, buffer) == 0) { @@ -274,7 +274,7 @@ void AP_InertialSensor_Flymaple::_accumulate(void) // Read gyro now = hal.scheduler->micros(); - // This takes about 500us at 200kHz I2C speed + // This takes about 250us at 400kHz I2C speed if ((now - _last_gyro_timestamp) >= raw_sample_interval_us && hal.i2c->readRegisters(FLYMAPLE_GYRO_ADDRESS, FLYMAPLE_GYRO_GYROX_H, 6, buffer) == 0) {