diff --git a/mk/PX4/ROMFS/init.d/rc.APM b/mk/PX4/ROMFS/init.d/rc.APM index c39a03d121..eb4da2fb49 100644 --- a/mk/PX4/ROMFS/init.d/rc.APM +++ b/mk/PX4/ROMFS/init.d/rc.APM @@ -267,14 +267,6 @@ fi echo "Trying PX4IO board" -# rgbled -if rgbled start -then - echo "rgbled started OK" -else - echo "Failed to start rgbled driver" >> $logfile -fi - if mtd start /fs/mtd then echo "started mtd driver OK" diff --git a/mk/PX4/ROMFS/init.d/rc.error b/mk/PX4/ROMFS/init.d/rc.error index 9e078a8b9a..9407754d8a 100644 --- a/mk/PX4/ROMFS/init.d/rc.error +++ b/mk/PX4/ROMFS/init.d/rc.error @@ -1,5 +1,12 @@ echo "Error in startup" + tone_alarm MNCC + +if [ $HAVE_RGBLED == 1 ] +then + rgbled rgb 16 0 0 +fi + nshterm /dev/ttyACM0 & sleep 1 nshterm /dev/ttyS0 & diff --git a/mk/PX4/ROMFS/init.d/rcS b/mk/PX4/ROMFS/init.d/rcS index 5f66dac86c..f74c56a68f 100755 --- a/mk/PX4/ROMFS/init.d/rcS +++ b/mk/PX4/ROMFS/init.d/rcS @@ -25,6 +25,15 @@ set USB autoconnect # +if rgbled start +then + set HAVE_RGBLED 1 + # show startup white + rgbled rgb 16 16 16 +else + set HAVE_RGBLED 0 +fi + # # Try to mount the microSD card. # @@ -40,6 +49,10 @@ else set HAVE_MICROSD 0 # Play SOS tone_alarm 2 + if [ $HAVE_RGBLED == 1 ] + then + rgbled rgb 16 0 0 + fi fi #