vmount: fix v1 frames with v2 input

It looks like the frames for pitch and roll were not set correctly when
v1 is used in v2 input.
This commit is contained in:
Julian Oes
2021-09-07 17:27:38 +02:00
committed by Daniel Agar
parent 0ce4eae314
commit f7c4034f3c
+2 -2
View File
@@ -634,8 +634,8 @@ int InputMavlinkGimbalV2::update_impl(unsigned int timeout_ms, ControlData **con
case vehicle_command_s::VEHICLE_MOUNT_MODE_MAVLINK_TARGETING: {
_control_data.type = ControlData::Type::Angle;
_control_data.type_data.angle.frames[0] = ControlData::TypeData::TypeAngle::Frame::AngleBodyFrame;
_control_data.type_data.angle.frames[1] = ControlData::TypeData::TypeAngle::Frame::AngleBodyFrame;
_control_data.type_data.angle.frames[0] = ControlData::TypeData::TypeAngle::Frame::AngleAbsoluteFrame;
_control_data.type_data.angle.frames[1] = ControlData::TypeData::TypeAngle::Frame::AngleAbsoluteFrame;
_control_data.type_data.angle.frames[2] = ControlData::TypeData::TypeAngle::Frame::AngleBodyFrame;
// vmount spec has roll on channel 0, MAVLink spec has pitch on channel 0