ekf2: selector improve status reporting

- publish estimator_selector_status at minimal rate or immediately on change
 - log all estimator_selector_status updates
This commit is contained in:
Daniel Agar
2021-01-08 11:27:12 -05:00
committed by Lorenz Meier
parent 2fc212e064
commit f73d93ef6c
3 changed files with 89 additions and 63 deletions
+1 -1
View File
@@ -114,7 +114,7 @@ void LoggedTopics::add_default_topics()
// EKF multi topics (currently max 9 estimators)
static constexpr uint8_t MAX_ESTIMATOR_INSTANCES = 4;
add_topic("estimator_selector_status", 200);
add_topic("estimator_selector_status");
add_topic_multi("ekf_gps_drift", 1000, MAX_ESTIMATOR_INSTANCES);
add_topic_multi("estimator_attitude", 500, MAX_ESTIMATOR_INSTANCES);
add_topic_multi("estimator_global_position", 1000, MAX_ESTIMATOR_INSTANCES);