diff --git a/src/platforms/posix/drivers/df_mpu9250_wrapper/df_mpu9250_wrapper.cpp b/src/platforms/posix/drivers/df_mpu9250_wrapper/df_mpu9250_wrapper.cpp index 9ddf27ee47..72159661ab 100644 --- a/src/platforms/posix/drivers/df_mpu9250_wrapper/df_mpu9250_wrapper.cpp +++ b/src/platforms/posix/drivers/df_mpu9250_wrapper/df_mpu9250_wrapper.cpp @@ -449,6 +449,7 @@ int DfMpu9250Wrapper::_publish(struct imu_sensor_data &data) // Bail out if it's not the 4th time yet. ++_publish_count; + if (_publish_count < 4) { return 0; }