diff --git a/src/main/drivers/accgyro_mpu6050.c b/src/main/drivers/accgyro_mpu6050.c
index d75dfab1aa..cddc23c990 100644
--- a/src/main/drivers/accgyro_mpu6050.c
+++ b/src/main/drivers/accgyro_mpu6050.c
@@ -20,6 +20,8 @@
 #include <stdlib.h>
 
 #include "platform.h"
+#include "build_config.h"
+#include "debug.h"
 
 #include "common/maths.h"
 
@@ -196,7 +198,8 @@ void MPU_DATA_READY_EXTI_Handler(void)
     uint32_t now = micros();
     callDelta = now - lastCalledAt;
 
-    UNUSED(callDelta);
+    //UNUSED(callDelta);
+    debug[0] = callDelta;
 
     lastCalledAt = now;
 #endif
diff --git a/src/main/drivers/barometer_bmp085.c b/src/main/drivers/barometer_bmp085.c
index 20558e431b..e09b5eac1e 100644
--- a/src/main/drivers/barometer_bmp085.c
+++ b/src/main/drivers/barometer_bmp085.c
@@ -209,7 +209,10 @@ bool bmp085Detect(const bmp085Config_t *config, baro_t *baro)
         return true;
     }
 
+#ifdef BARO_EOC_GPIO
     unregisterExti15_10_CallbackHandler(BMP085_EOC_EXTI_Handler);
+#endif
+
     BMP085_OFF;
 
     return false;