|
|
@ -235,10 +235,10 @@ void AP_VideoTX::update(void) |
|
|
|
// manipulate pitmode if pitmode-on-disarm or power-on-arm is set
|
|
|
|
// manipulate pitmode if pitmode-on-disarm or power-on-arm is set
|
|
|
|
if (has_option(VideoOptions::VTX_PITMODE_ON_DISARM) || has_option(VideoOptions::VTX_PITMODE_UNTIL_ARM)) { |
|
|
|
if (has_option(VideoOptions::VTX_PITMODE_ON_DISARM) || has_option(VideoOptions::VTX_PITMODE_UNTIL_ARM)) { |
|
|
|
if (hal.util->get_soft_armed() && has_option(VideoOptions::VTX_PITMODE)) { |
|
|
|
if (hal.util->get_soft_armed() && has_option(VideoOptions::VTX_PITMODE)) { |
|
|
|
_options &= ~uint8_t(VideoOptions::VTX_PITMODE); |
|
|
|
_options.set(_options & ~uint8_t(VideoOptions::VTX_PITMODE)); |
|
|
|
} else if (!hal.util->get_soft_armed() && !has_option(VideoOptions::VTX_PITMODE) |
|
|
|
} else if (!hal.util->get_soft_armed() && !has_option(VideoOptions::VTX_PITMODE) |
|
|
|
&& has_option(VideoOptions::VTX_PITMODE_ON_DISARM)) { |
|
|
|
&& has_option(VideoOptions::VTX_PITMODE_ON_DISARM)) { |
|
|
|
_options |= uint8_t(VideoOptions::VTX_PITMODE); |
|
|
|
_options.set(_options | uint8_t(VideoOptions::VTX_PITMODE)); |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|