|
|
|
@ -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; |
|
|
|
|
|
|
|
|
|