diff --git a/boards/px4/fmu-v5/debug.cmake b/boards/px4/fmu-v5/debug.cmake
index a7d75cadf1..420f0ad62b 100644
--- a/boards/px4/fmu-v5/debug.cmake
+++ b/boards/px4/fmu-v5/debug.cmake
@@ -17,7 +17,8 @@ px4_add_board(
 		TEL4:/dev/ttyS3
 	DRIVERS
 		adc
-		barometer # all available barometer drivers
+		#barometer # all available barometer drivers
+		barometer/ms5611
 		#batt_smbus
 		camera_capture
 		camera_trigger
@@ -34,34 +35,34 @@ px4_add_board(
 		#imu/invensense/icm20602
 		imu/invensense/icm20689
 		#imu/mpu6000 # legacy icm20602/icm20689 driver
-		irlock
-		lights/blinkm
+		#irlock
+		#lights/blinkm
 		lights/rgbled
 		lights/rgbled_ncp5623c
 		lights/rgbled_pwm
 		magnetometer # all available magnetometer drivers
-		mkblctrl
+		#mkblctrl
 		optical_flow # all available optical flow drivers
 		#osd
-		pca9685
-		power_monitor/ina226
+		#pca9685
+		#power_monitor/ina226
 		#protocol_splitter
 		pwm_input
 		pwm_out_sim
 		pwm_out
 		px4io
 		rc_input
-		roboclaw
+		#roboclaw
 		rpm
 		safety_button
-		tap_esc
+		#tap_esc
 		telemetry # all available telemetry drivers
 		test_ppm
 		tone_alarm
 		#uavcan
 	MODULES
 		airspeed_selector
-		attitude_estimator_q
+		#attitude_estimator_q
 		battery_status
 		#camera_feedback
 		commander
diff --git a/boards/px4/fmu-v5/stackcheck.cmake b/boards/px4/fmu-v5/stackcheck.cmake
index d8bc7021e4..be0249c06b 100644
--- a/boards/px4/fmu-v5/stackcheck.cmake
+++ b/boards/px4/fmu-v5/stackcheck.cmake
@@ -53,6 +53,7 @@ px4_add_board(
 		px4io
 		rc_input
 		#roboclaw
+		#rpm
 		safety_button
 		#tap_esc
 		telemetry # all available telemetry drivers
@@ -95,6 +96,7 @@ px4_add_board(
 		dmesg
 		dumpfile
 		esc_calib
+		gpio
 		hardfault_log
 		i2cdetect
 		led_control
@@ -117,6 +119,7 @@ px4_add_board(
 		ver
 		work_queue
 	EXAMPLES
+		#fake_magnetometer
 		#fixedwing_control # Tutorial code from https://px4.io/dev/example_fixedwing_control
 		#hello
 		#hwtest # Hardware test