diff --git a/libraries/AP_HAL_ChibiOS/I2CDevice.cpp b/libraries/AP_HAL_ChibiOS/I2CDevice.cpp index 61d871bbcc..b78ce19c05 100644 --- a/libraries/AP_HAL_ChibiOS/I2CDevice.cpp +++ b/libraries/AP_HAL_ChibiOS/I2CDevice.cpp @@ -280,6 +280,9 @@ bool I2CDevice::_transfer(const uint8_t *send, uint32_t send_len, break; } + AP_HAL::Util::PersistentData &pd = hal.util->persistent_data; + pd.i2c_isr_count += I2CD[bus.busnum].i2c->isr_count; + if (ret == MSG_OK) { bus.bouncebuffer_finish(send, recv, recv_len); i2cReleaseBus(I2CD[bus.busnum].i2c);