diff --git a/cmake/configs/nuttx_px4fmu-v2_test.cmake b/cmake/configs/nuttx_px4fmu-v2_test.cmake
index f824247c3a5..b1fc89ccc2a 100644
--- a/cmake/configs/nuttx_px4fmu-v2_test.cmake
+++ b/cmake/configs/nuttx_px4fmu-v2_test.cmake
@@ -47,7 +47,8 @@ set(config_module_list
 	drivers/camera_trigger
 	drivers/bst
 	drivers/snapdragon_rc_pwm
-	drivers/lis3mdl
+	#drivers/lis3mdl
+	#drivers/bmi160
 
 	#
 	# System commands
@@ -82,6 +83,7 @@ set(config_module_list
 	# General system control
 	#
 	modules/commander
+	modules/load_mon
 	modules/navigator
 	modules/mavlink
 	modules/gpio_led
diff --git a/cmake/configs/posix_sitl_default.cmake b/cmake/configs/posix_sitl_default.cmake
index 69e76dfa810..365397341a1 100644
--- a/cmake/configs/posix_sitl_default.cmake
+++ b/cmake/configs/posix_sitl_default.cmake
@@ -44,7 +44,6 @@ set(config_module_list
 	modules/mc_att_control
 	modules/mc_att_control_multiplatform
 	modules/mc_pos_control
-
 	modules/mc_pos_control_multiplatform
 	modules/navigator
 	modules/param
diff --git a/cmake/configs/posix_sitl_test.cmake b/cmake/configs/posix_sitl_test.cmake
index 12eb54dfdbf..5a7d9cd9bd9 100644
--- a/cmake/configs/posix_sitl_test.cmake
+++ b/cmake/configs/posix_sitl_test.cmake
@@ -26,6 +26,7 @@ set(config_module_list
 	systemcmds/param
 	systemcmds/perf
 	systemcmds/reboot
+	systemcmds/sd_bench
 	systemcmds/topic_listener
 	systemcmds/ver
 
@@ -38,6 +39,7 @@ set(config_module_list
 	modules/fw_att_control
 	modules/fw_pos_control_l1
 	modules/land_detector
+	modules/load_mon
 	modules/mavlink
 	modules/mc_att_control
 	modules/mc_att_control_multiplatform