diff --git a/ROMFS/px4fmu_test/init.d/rcS b/ROMFS/px4fmu_test/init.d/rcS
index 0f2d32cb3fa..233a098b89b 100644
--- a/ROMFS/px4fmu_test/init.d/rcS
+++ b/ROMFS/px4fmu_test/init.d/rcS
@@ -6,6 +6,11 @@ set unit_test_failure 0
 
 uorb start
 
+if rgbled start
+then
+	rgbled rgb 20 20 255
+fi
+
 if sercon
 then
 	echo "[i] USB interface connected"
@@ -217,9 +222,11 @@ if [ $unit_test_failure == 0 ]
 then
 	echo
 	echo "All Unit Tests PASSED"
+	rgbled rgb 20 255 20
 else
 	echo
 	echo "Some Unit Tests FAILED:${unit_test_failure_list}"
+	rgbled rgb 255 20 20
 fi
 
 ver all