diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 44736fc..eaf78fb 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -247,7 +247,7 @@ else
 	#
 	# Start the resource load monitor.
 	#
-#	load_mon start
+	load_mon start
 
 	#
 	# Start system state indicator.
@@ -379,8 +379,8 @@ else
 		#	battery_status start
 		#fi
 
-		#sensors start
-		#commander start
+		sensors start
+		commander start
 
 		#dshot start
 		#pwm_out start
@@ -429,7 +429,7 @@ else
 	#
 	# Start the navigator.
 	#
-	#navigator start
+	navigator start
 
 	#
 	# Start a thermal calibration if required.
diff --git a/boards/px4/fmu-v6c/init/rc.board_defaults b/boards/px4/fmu-v6c/init/rc.board_defaults
index 6418e58..8c62eea 100644
--- a/boards/px4/fmu-v6c/init/rc.board_defaults
+++ b/boards/px4/fmu-v6c/init/rc.board_defaults
@@ -11,3 +11,11 @@ param set-default BAT1_A_PER_V 36.367515152
 param set-default BAT2_A_PER_V 36.367515152
 
 param set-default SYS_USE_IO 1
+
+# MAIN-FTS INTERFACE (9600 BAUD)
+# MAV_0 - TELEM 1 - TTYS5 - UART7 (PE7/PE8)
+param set-default MAV_0_CONFIG 101
+param set-default MAV_0_FORWARD 0
+param set-default MAV_0_MODE 1
+param set-default MAV_0_RADIO_CTL 0
+param set-default MAV_0_RATE 2400
\ No newline at end of file
diff --git a/boards/px4/fts-auto/init/rc.board_defaults b/boards/px4/fts-auto/init/rc.board_defaults
index 081e021..038302e 100644
--- a/boards/px4/fts-auto/init/rc.board_defaults
+++ b/boards/px4/fts-auto/init/rc.board_defaults
@@ -18,3 +18,5 @@ param set-default MAV_0_FORWARD 0
 param set-default MAV_0_MODE 1
 param set-default MAV_0_RADIO_CTL 0
 param set-default MAV_0_RATE 2400
+
+navigator start
\ No newline at end of file