mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
Autostart: tones cleanup
This commit is contained in:
@@ -14,5 +14,11 @@ param set MAV_TYPE 1
|
|||||||
#
|
#
|
||||||
echo "[init] Frame geometry: $FRAME_GEOMETRY"
|
echo "[init] Frame geometry: $FRAME_GEOMETRY"
|
||||||
set MIXER /etc/mixers/FMU_$FRAME_GEOMETRY.mix
|
set MIXER /etc/mixers/FMU_$FRAME_GEOMETRY.mix
|
||||||
echo "[init] Loading mixer: $MIXER"
|
|
||||||
mixer load /dev/pwm_output $MIXER
|
if mixer load /dev/pwm_output $MIXER
|
||||||
|
then
|
||||||
|
echo "[init] Mixer loaded: $MIXER"
|
||||||
|
else
|
||||||
|
echo "[init] Error loading mixer: $MIXER"
|
||||||
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
|
fi
|
||||||
|
|||||||
@@ -29,14 +29,21 @@ fi
|
|||||||
#
|
#
|
||||||
echo "[init] Frame geometry: $FRAME_GEOMETRY"
|
echo "[init] Frame geometry: $FRAME_GEOMETRY"
|
||||||
set MIXER /etc/mixers/FMU_$FRAME_GEOMETRY.mix
|
set MIXER /etc/mixers/FMU_$FRAME_GEOMETRY.mix
|
||||||
echo "[init] Loading mixer: $MIXER"
|
|
||||||
if [ $OUTPUT_MODE == mkblctrl ]
|
if [ $OUTPUT_MODE == mkblctrl ]
|
||||||
then
|
then
|
||||||
set OUTPUT_DEV /dev/mkblctrl
|
set OUTPUT_DEV /dev/mkblctrl
|
||||||
else
|
else
|
||||||
set OUTPUT_DEV /dev/pwm_output
|
set OUTPUT_DEV /dev/pwm_output
|
||||||
fi
|
fi
|
||||||
mixer load $OUTPUT_DEV $MIXER
|
|
||||||
|
if mixer load $OUTPUT_DEV $MIXER
|
||||||
|
then
|
||||||
|
echo "[init] Mixer loaded: $MIXER"
|
||||||
|
else
|
||||||
|
echo "[init] Error loading mixer: $MIXER"
|
||||||
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
|
fi
|
||||||
|
|
||||||
if [ $OUTPUT_MODE == fmu -o $OUTPUT_MODE == io ]
|
if [ $OUTPUT_MODE == fmu -o $OUTPUT_MODE == io ]
|
||||||
then
|
then
|
||||||
|
|||||||
@@ -13,6 +13,7 @@ set RC_FILE /fs/microsd/etc/rc.txt
|
|||||||
set CONFIG_FILE /fs/microsd/etc/config.txt
|
set CONFIG_FILE /fs/microsd/etc/config.txt
|
||||||
set EXTRAS_FILE /fs/microsd/etc/extras.txt
|
set EXTRAS_FILE /fs/microsd/etc/extras.txt
|
||||||
|
|
||||||
|
set TUNE_OUT_ERROR ML<<CP4CP4CP4CP4CP4
|
||||||
#
|
#
|
||||||
# Try to mount the microSD card.
|
# Try to mount the microSD card.
|
||||||
#
|
#
|
||||||
@@ -174,7 +175,9 @@ then
|
|||||||
else
|
else
|
||||||
echo "[init] PX4IO CRC failure"
|
echo "[init] PX4IO CRC failure"
|
||||||
echo "PX4IO CRC failure" >> $LOG_FILE
|
echo "PX4IO CRC failure" >> $LOG_FILE
|
||||||
tone_alarm MBABGP
|
|
||||||
|
tone_alarm MLL32CP8MB
|
||||||
|
|
||||||
if px4io forceupdate 14662 $IO_FILE
|
if px4io forceupdate 14662 $IO_FILE
|
||||||
then
|
then
|
||||||
usleep 500000
|
usleep 500000
|
||||||
@@ -182,7 +185,7 @@ then
|
|||||||
then
|
then
|
||||||
echo "[init] PX4IO CRC OK after updating"
|
echo "[init] PX4IO CRC OK after updating"
|
||||||
echo "PX4IO CRC OK after updating" >> $LOG_FILE
|
echo "PX4IO CRC OK after updating" >> $LOG_FILE
|
||||||
tone_alarm MSPAA
|
tone_alarm MLL8CDE
|
||||||
|
|
||||||
set IO_PRESENT yes
|
set IO_PRESENT yes
|
||||||
else
|
else
|
||||||
@@ -197,9 +200,8 @@ then
|
|||||||
|
|
||||||
if [ $IO_PRESENT == no ]
|
if [ $IO_PRESENT == no ]
|
||||||
then
|
then
|
||||||
echo "[init] ERROR: PX4IO not found, set vehicle type to NONE"
|
echo "[init] ERROR: PX4IO not found"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
set VEHICLE_TYPE none
|
|
||||||
fi
|
fi
|
||||||
fi
|
fi
|
||||||
|
|
||||||
@@ -245,7 +247,7 @@ then
|
|||||||
sh /etc/init.d/rc.io
|
sh /etc/init.d/rc.io
|
||||||
else
|
else
|
||||||
echo "[init] PX4IO start error"
|
echo "[init] PX4IO start error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
fi
|
fi
|
||||||
if [ $OUTPUT_MODE == fmu ]
|
if [ $OUTPUT_MODE == fmu ]
|
||||||
@@ -256,7 +258,7 @@ then
|
|||||||
echo "[init] FMU mode_$FMU_MODE started"
|
echo "[init] FMU mode_$FMU_MODE started"
|
||||||
else
|
else
|
||||||
echo "[init] FMU mode_$FMU_MODE start error"
|
echo "[init] FMU mode_$FMU_MODE start error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
|
|
||||||
if hw_ver compare PX4FMU_V1
|
if hw_ver compare PX4FMU_V1
|
||||||
@@ -289,7 +291,7 @@ then
|
|||||||
echo "[init] MKBLCTRL started"
|
echo "[init] MKBLCTRL started"
|
||||||
else
|
else
|
||||||
echo "[init] MKBLCTRL start error"
|
echo "[init] MKBLCTRL start error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
|
|
||||||
fi
|
fi
|
||||||
@@ -301,7 +303,7 @@ then
|
|||||||
echo "[init] HIL output started"
|
echo "[init] HIL output started"
|
||||||
else
|
else
|
||||||
echo "[init] HIL output error"
|
echo "[init] HIL output error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
fi
|
fi
|
||||||
|
|
||||||
@@ -318,7 +320,7 @@ then
|
|||||||
sh /etc/init.d/rc.io
|
sh /etc/init.d/rc.io
|
||||||
else
|
else
|
||||||
echo "[init] PX4IO start error"
|
echo "[init] PX4IO start error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
fi
|
fi
|
||||||
else
|
else
|
||||||
@@ -329,7 +331,7 @@ then
|
|||||||
echo "[init] FMU mode_$FMU_MODE started"
|
echo "[init] FMU mode_$FMU_MODE started"
|
||||||
else
|
else
|
||||||
echo "[init] FMU mode_$FMU_MODE start error"
|
echo "[init] FMU mode_$FMU_MODE start error"
|
||||||
tone_alarm MNGGG
|
tone_alarm $TUNE_OUT_ERROR
|
||||||
fi
|
fi
|
||||||
|
|
||||||
if hw_ver compare PX4FMU_V1
|
if hw_ver compare PX4FMU_V1
|
||||||
|
|||||||
Reference in New Issue
Block a user