diff --git a/boards/modalai/voxl2-slpi/default.px4board b/boards/modalai/voxl2-slpi/default.px4board
index 6473ff63f8..c548eaf90c 100644
--- a/boards/modalai/voxl2-slpi/default.px4board
+++ b/boards/modalai/voxl2-slpi/default.px4board
@@ -5,6 +5,7 @@ CONFIG_DRIVERS_BAROMETER_INVENSENSE_ICP101XX=y
 CONFIG_DRIVERS_BAROMETER_MS5611=y
 CONFIG_DRIVERS_BAROMETER_BMP280=y
 CONFIG_DRIVERS_BAROMETER_BMP388=y
+CONFIG_DRIVERS_DIFFERENTIAL_PRESSURE_MS4525DO=y
 CONFIG_DRIVERS_DISTANCE_SENSOR_VL53L0X=y
 CONFIG_DRIVERS_DISTANCE_SENSOR_VL53L1X=y
 CONFIG_DRIVERS_GPS=y
diff --git a/src/drivers/differential_pressure/ms4525do/MS4525DO.cpp b/src/drivers/differential_pressure/ms4525do/MS4525DO.cpp
index fcce76edda..8fa255c67d 100644
--- a/src/drivers/differential_pressure/ms4525do/MS4525DO.cpp
+++ b/src/drivers/differential_pressure/ms4525do/MS4525DO.cpp
@@ -70,7 +70,7 @@ int MS4525DO::probe()
 
 			if ((status_1 == (uint8_t)STATUS::Normal_Operation)
 			    && (status_2 == (uint8_t)STATUS::Stale_Data)
-			    && (data_1[2] == data_1[2])) {
+			    && (data_1[2] == data_2[2])) {
 
 				_retries = 1; // enable retries during operation
 				return PX4_OK;