diff --git a/esp32/include/peripherals/imu.h b/esp32/include/peripherals/imu.h
index 6f2f813..6b095ff 100644
--- a/esp32/include/peripherals/imu.h
+++ b/esp32/include/peripherals/imu.h
@@ -86,8 +86,10 @@ class IMU : public SensorBase<IMUAnglesMsg> {
         #ifndef ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
         #define ICM20948_GET_AGMT_UPDATED_ONCE_PER_LOOP
         if (_imu->dataReady())
-        { 
+        {
             _imu->getAGMT();
+        } else {
+            return false;
         }
         #endif
         _msg.rpy[0] = _imu->accX();
diff --git a/esp32/include/peripherals/magnetometer.h b/esp32/include/peripherals/magnetometer.h
index ad019e2..9dd05ae 100644
--- a/esp32/include/peripherals/magnetometer.h
+++ b/esp32/include/peripherals/magnetometer.h
@@ -48,6 +48,8 @@ class Magnetometer : public SensorBase<MagnetometerMsg> {
         if (_imu->dataReady())
         { 
             _imu->getAGMT();
+        } else {
+            return false;
         }
         #endif
         _msg.rpy[0] = _mag->magX();