|
|
|
@ -426,33 +426,29 @@ then
@@ -426,33 +426,29 @@ then
|
|
|
|
|
set OUTPUT_MODE uavcan_esc |
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|
if ver hwcmp PX4_SAME70XPLAINED_V1 |
|
|
|
|
# Sensors on the PWM interface bank |
|
|
|
|
if param compare SENS_EN_LL40LS 1 |
|
|
|
|
then |
|
|
|
|
else |
|
|
|
|
# Sensors on the PWM interface bank |
|
|
|
|
if param compare SENS_EN_LL40LS 1 |
|
|
|
|
# clear pins 5 and 6 |
|
|
|
|
set FMU_MODE pwm4 |
|
|
|
|
set AUX_MODE pwm4 |
|
|
|
|
fi |
|
|
|
|
if param greater TRIG_MODE 0 |
|
|
|
|
then |
|
|
|
|
# We ONLY support trigger on pins 5 and 6 when simultanously using AUX for actuator output |
|
|
|
|
if param compare TRIG_PINS 56 |
|
|
|
|
then |
|
|
|
|
# clear pins 5 and 6 |
|
|
|
|
set FMU_MODE pwm4 |
|
|
|
|
set AUX_MODE pwm4 |
|
|
|
|
else |
|
|
|
|
set FMU_MODE none |
|
|
|
|
set AUX_MODE none |
|
|
|
|
fi |
|
|
|
|
if param greater TRIG_MODE 0 |
|
|
|
|
then |
|
|
|
|
# We ONLY support trigger on pins 5 and 6 when simultanously using AUX for actuator output |
|
|
|
|
if param compare TRIG_PINS 56 |
|
|
|
|
then |
|
|
|
|
# clear pins 5 and 6 |
|
|
|
|
set FMU_MODE pwm4 |
|
|
|
|
set AUX_MODE pwm4 |
|
|
|
|
else |
|
|
|
|
set FMU_MODE none |
|
|
|
|
set AUX_MODE none |
|
|
|
|
fi |
|
|
|
|
camera_trigger start |
|
|
|
|
camera_trigger start |
|
|
|
|
|
|
|
|
|
param set CAM_FBACK_MODE 1 |
|
|
|
|
camera_feedback start |
|
|
|
|
fi |
|
|
|
|
param set CAM_FBACK_MODE 1 |
|
|
|
|
camera_feedback start |
|
|
|
|
fi |
|
|
|
|
|
|
|
|
|
# If OUTPUT_MODE == none then something is wrong with setup and we shouldn't try to enable output |
|
|
|
|