Browse Source

AP_Mount: gremsy neutral mode leaves ef targets untouched

apm_2208
Randy Mackay 3 years ago
parent
commit
23209ddafd
  1. 7
      libraries/AP_Mount/AP_Mount_Gremsy.cpp

7
libraries/AP_Mount/AP_Mount_Gremsy.cpp

@ -32,11 +32,8 @@ void AP_Mount_Gremsy::update() @@ -32,11 +32,8 @@ void AP_Mount_Gremsy::update()
// move mount to a neutral position, typically pointing forward
case MAV_MOUNT_MODE_NEUTRAL: {
const Vector3f &target = _state._neutral_angles.get();
_angle_ef_target_rad.x = ToRad(target.x);
_angle_ef_target_rad.y = ToRad(target.y);
_angle_ef_target_rad.z = ToRad(target.z);
send_gimbal_device_set_attitude(_angle_ef_target_rad.x, _angle_ef_target_rad.y, _angle_ef_target_rad.z, false);
const Vector3f &angle_bf_target = _state._neutral_angles.get();
send_gimbal_device_set_attitude(ToRad(angle_bf_target.x), ToRad(angle_bf_target.y), ToRad(angle_bf_target.z), false);
}
break;

Loading…
Cancel
Save