ardupilot/mk/VRBRAIN/ROMFS/init.d/rc.APMNS

122 lines
2.3 KiB
Plaintext

#!nsh
# APM startup script for NuttX on VRBRAIN
# mount binfs so we can find the built-in apps
if [ -f /bin/reboot ]
then
echo "[APMNS] binfs already mounted"
else
echo "[APMNS] Mounting binfs"
if mount -t binfs /dev/null /bin
then
echo "[APMNS] binfs mounted OK"
else
sh /etc/init.d/rc.error
fi
fi
if [ ! -f /bin/ArduPilot ]
then
echo "[APMNS] /bin/ArduPilot not found"
sh /etc/init.d/rc.error
fi
echo "[APMNS] Starting UORB"
if uorb start
then
echo "[APMNS] UORB started OK"
else
sh /etc/init.d/rc.error
fi
echo "[APMNS] Starting ADC"
if adc start
then
echo "[APMNS] ADC started OK"
else
sh /etc/init.d/rc.error
fi
echo "[APMNS] Starting APM sensors"
if ms5611 start
then
echo "[APMNS] MS5611 started OK"
else
echo "[APMNS] MS5611 start failed"
sh /etc/init.d/rc.error
fi
if hmc5883 start
then
echo "[APMNS] HMC5883 started OK"
else
echo "[APMNS] HMC5883 start failed"
sh /etc/init.d/rc.error
fi
if mpu6000 start
then
echo "[APMNS] MPU6000 started OK"
else
echo "[APMNS] MPU6000 start failed"
sh /etc/init.d/rc.error
fi
echo "[APMNS] Starting MTD driver"
if mtd start /fs/mtd
then
echo "[APMNS] MTD driver started OK"
else
echo "[APMNS] MTD driver start failed"
sh /etc/init.d/rc.error
fi
echo "[APMNS] MTD driver read test"
if mtd readtest /fs/mtd
then
echo "[APMNS] MTD driver readtest OK"
else
echo "[APMNS] MTD driver failed to read"
sh /etc/init.d/rc.error
fi
echo "[APMNS] Starting VROUTPUT driver"
vroutput mode_pwm
#if vroutput mode_pwm
#then
# echo "[APMNS] VROUTPUT driver started OK"
#else
# echo "[APMNS] VROUTPUT driver start failed"
# sh /etc/init.d/rc.error
#fi
echo "[APMNS] Starting VRINPUT driver"
vrinput start
#if vrinput start
#then
# echo "[APMNS] VRINPUT driver started OK"
#else
# echo "[APMNS] VRINPUT driver start failed"
# sh /etc/init.d/rc.error
#fi
set sketch NONE
set deviceA /dev/ttyACM0
set deviceC /dev/ttyS2
echo "[APMNS] Starting ArduPilot" $deviceA $deviceC
if ArduPilot -d $deviceA -d2 $deviceC start
then
echo "[APMNS] ArduPilot started OK"
else
echo "[APMNS] ArduPilot start failed"
sh /etc/init.d/rc.error
fi
echo "[APMNS] Exiting from nsh shell"
exit
echo "[APMNS] Script finished"