vmount: set output to Neutral for VEHICLE_ROI_NONE

This commit is contained in:
Beat Küng 2017-04-12 10:05:53 +02:00
parent c20ff1737c
commit ed577f705d
1 changed files with 3 additions and 0 deletions

View File

@ -121,6 +121,9 @@ int InputMavlinkROI::update_impl(unsigned int timeout_ms, ControlData **control_
if (vehicle_roi.mode == vehicle_roi_s::VEHICLE_ROI_NONE) { if (vehicle_roi.mode == vehicle_roi_s::VEHICLE_ROI_NONE) {
_control_data.type = ControlData::Type::Neutral;
*control_data = &_control_data;
} else if (vehicle_roi.mode == vehicle_roi_s::VEHICLE_ROI_WPNEXT) { } else if (vehicle_roi.mode == vehicle_roi_s::VEHICLE_ROI_WPNEXT) {
_read_control_data_from_position_setpoint_sub(); _read_control_data_from_position_setpoint_sub();
_control_data.type_data.lonlat.roll_angle = 0.f; _control_data.type_data.lonlat.roll_angle = 0.f;