EKF2: send event when yaw gets aligned

PX4 · Nov 27, 2024 · 170215a · 170215a
1 parent 1af2f12
commit 170215a
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/src/modules/ekf2/EKF2.cpp b/src/modules/ekf2/EKF2.cpp
@@ -1265,6 +1265,14 @@ void EKF2::SendEvents()
 
 		_ekf.clear_information_events();
 	}
+
+	if (_ekf.control_status_flags().yaw_align && !_ekf.control_status_prev_flags().yaw_align) {
+		/* EVENT
+		 * @group ekf2
+		 */
+		events::send<int32_t>(events::ID("ekf2_yaw_align"), events::Log::Debug,
+				      "EKF2({1}): yaw aligned", _instance);
+	}
 }
 
 void EKF2::PublishGlobalPosition(const hrt_abstime &timestamp)