diff options
| author | Anton Babushkin <anton.babushkin@me.com> | 2014-01-15 00:02:57 +0100 |
|---|---|---|
| committer | Anton Babushkin <anton.babushkin@me.com> | 2014-01-15 00:02:57 +0100 |
| commit | a8d362de13b23a2523dc69d582c68fe672ac236d (patch) | |
| tree | 52b3c72b9c326299e234915503a6efd5dfa5e587 /ROMFS/px4fmu_common/init.d/rc.interface | |
| parent | d1b2186806e0b9e32808a04f6c85d26a703c596e (diff) | |
| download | px4-firmware-a8d362de13b23a2523dc69d582c68fe672ac236d.tar.gz px4-firmware-a8d362de13b23a2523dc69d582c68fe672ac236d.tar.bz2 px4-firmware-a8d362de13b23a2523dc69d582c68fe672ac236d.zip | |
Autostart: use MIXER instead of FRAME_GEOMETRY
Diffstat (limited to 'ROMFS/px4fmu_common/init.d/rc.interface')
| -rw-r--r-- | ROMFS/px4fmu_common/init.d/rc.interface | 72 |
1 files changed, 72 insertions, 0 deletions
diff --git a/ROMFS/px4fmu_common/init.d/rc.interface b/ROMFS/px4fmu_common/init.d/rc.interface new file mode 100644 index 000000000..928d3aeeb --- /dev/null +++ b/ROMFS/px4fmu_common/init.d/rc.interface @@ -0,0 +1,72 @@ +#!nsh +# +# Script to configure control interface +# + +if [ $MIXER != none ] +then + # + # Load mixer + # + set MIXERSD /fs/microsd/etc/mixers/$MIXER.mix + + #Use the mixer file from the SD-card if it exists + if [ -f $MIXERSD ] + then + set MIXER_FILE $MIXERSD + else + set MIXER_FILE /etc/mixers/$MIXER.mix + fi + + if [ $OUTPUT_MODE == mkblctrl ] + then + set OUTPUT_DEV /dev/mkblctrl + else + set OUTPUT_DEV /dev/pwm_output + fi + + if mixer load $OUTPUT_DEV $MIXER_FILE + then + echo "[init] Mixer loaded: $MIXER_FILE" + else + echo "[init] Error loading mixer: $MIXER_FILE" + tone_alarm $TUNE_OUT_ERROR + fi +else + echo "[init] Mixer not defined + tone_alarm $TUNE_OUT_ERROR +fi + +if [ $OUTPUT_MODE == fmu -o $OUTPUT_MODE == io ] +then + if [ $PWM_OUTPUTS != none ] + then + # + # Set PWM output frequency + # + if [ $PWM_RATE != none ] + then + echo "[init] Set PWM rate: $PWM_RATE" + pwm rate -c $PWM_OUTPUTS -r $PWM_RATE + fi + + # + # Set disarmed, min and max PWM values + # + if [ $PWM_DISARMED != none ] + then + echo "[init] Set PWM disarmed: $PWM_DISARMED" + pwm disarmed -c $PWM_OUTPUTS -p $PWM_DISARMED + fi + if [ $PWM_MIN != none ] + then + echo "[init] Set PWM min: $PWM_MIN" + pwm min -c $PWM_OUTPUTS -p $PWM_MIN + fi + if [ $PWM_MAX != none ] + then + echo "[init] Set PWM max: $PWM_MAX" + pwm max -c $PWM_OUTPUTS -p $PWM_MAX + fi + fi +fi |