mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-31 10:26:52 +08:00
ekf2: fix terrain range finder logging
This commit is contained in:
@@ -239,7 +239,7 @@ void Ekf::updateHaglRng(estimator_aid_source1d_s &aid_src) const
|
|||||||
|
|
||||||
aid_src.timestamp_sample = _time_delayed_us; // TODO
|
aid_src.timestamp_sample = _time_delayed_us; // TODO
|
||||||
|
|
||||||
aid_src.observation = pred_hagl;
|
aid_src.observation = meas_hagl;
|
||||||
aid_src.observation_variance = obs_variance;
|
aid_src.observation_variance = obs_variance;
|
||||||
|
|
||||||
aid_src.innovation = hagl_innov;
|
aid_src.innovation = hagl_innov;
|
||||||
|
|||||||
@@ -291,6 +291,7 @@ void LoggedTopics::add_default_topics()
|
|||||||
add_optional_topic_multi("estimator_aid_src_mag", 0, MAX_ESTIMATOR_INSTANCES);
|
add_optional_topic_multi("estimator_aid_src_mag", 0, MAX_ESTIMATOR_INSTANCES);
|
||||||
add_optional_topic_multi("estimator_aid_src_optical_flow", 0, MAX_ESTIMATOR_INSTANCES);
|
add_optional_topic_multi("estimator_aid_src_optical_flow", 0, MAX_ESTIMATOR_INSTANCES);
|
||||||
add_optional_topic_multi("estimator_aid_src_terrain_optical_flow", 0, MAX_ESTIMATOR_INSTANCES);
|
add_optional_topic_multi("estimator_aid_src_terrain_optical_flow", 0, MAX_ESTIMATOR_INSTANCES);
|
||||||
|
add_optional_topic_multi("estimator_aid_src_terrain_range_finder", 0, MAX_ESTIMATOR_INSTANCES);
|
||||||
add_optional_topic_multi("estimator_aid_src_sideslip", 0, MAX_ESTIMATOR_INSTANCES);
|
add_optional_topic_multi("estimator_aid_src_sideslip", 0, MAX_ESTIMATOR_INSTANCES);
|
||||||
|
|
||||||
#endif /* CONFIG_ARCH_BOARD_PX4_SITL */
|
#endif /* CONFIG_ARCH_BOARD_PX4_SITL */
|
||||||
|
|||||||
Reference in New Issue
Block a user