|
|
|
@ -783,8 +783,6 @@ void QuadPlane::check_yaw_reset(void)
@@ -783,8 +783,6 @@ void QuadPlane::check_yaw_reset(void)
|
|
|
|
|
float yaw_angle_change_rad = 0.0f; |
|
|
|
|
uint32_t new_ekfYawReset_ms = ahrs.getLastYawResetAngle(yaw_angle_change_rad); |
|
|
|
|
if (new_ekfYawReset_ms != ekfYawReset_ms) { |
|
|
|
|
// we only reset if the EKF yaw reset happened since the last
|
|
|
|
|
// mode change. This prevents a past reset from before
|
|
|
|
|
attitude_control->shift_ef_yaw_target(degrees(yaw_angle_change_rad) * 100); |
|
|
|
|
ekfYawReset_ms = new_ekfYawReset_ms; |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF yaw reset %.2f", degrees(yaw_angle_change_rad)); |
|
|
|
|