Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

feat(imu_corrector): changed input topic of GyroBiasEstimator from ndt_pose to ekf_odom #5374

Conversation

SakodaShintaro
Copy link
Contributor

@SakodaShintaro SakodaShintaro commented Oct 23, 2023

Description

Change the input topic used by GyroBiasEstimator from /localization/pose_estimator/pose_with_covariance to /localization/kinematic_state.

This change comes from the idea that /localization/kinematic_state is a more formal pose output from the localization module.

It should be noted that EKF is dependent on the IMU, so the EKF itself will be slightly affected when the IMU bias is not fully compensated.

However, if NDT is used as the pose_estimator, experiments have shown that the effect is small.

Related link

Tests performed

In sample rosbag

Before(ndt_pose) After(ekf_odom)
estimated_gyro_bias_before_sample estimated_gyro_bias_after_sample

In internal rosbag

The experiment was conducted using the IMU bias calibrated in September.

Month Before(ndt_pose) After(ekf_odom)
2023/06 estimated_gyro_bias_before_ndt_06 estimated_gyro_bias_before_ekf_06
2023/09 estimated_gyro_bias_09_before estimated_gyro_bias_09_ekf

The change from NDT to EKF has little effect on the results.

The module can detect a change in yaw bias from June to September.

Effects on system behavior

The output values to diagnostics are only slightly changed.

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

@github-actions github-actions bot added the component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) label Oct 23, 2023
@SakodaShintaro SakodaShintaro added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Oct 23, 2023
@SakodaShintaro SakodaShintaro changed the title refactor(imu_corrector): changed input topic of GyroBiasEstimator from ndt_pose to ekf_odom feat(imu_corrector): changed input topic of GyroBiasEstimator from ndt_pose to ekf_odom Oct 23, 2023
@SakodaShintaro SakodaShintaro marked this pull request as ready for review October 23, 2023 06:45
Copy link
Contributor

@TaikiYamada4 TaikiYamada4 left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Tested in rosbag replay simulation in the tutorial and performed well.
LGTM!

@SakodaShintaro SakodaShintaro merged commit 0f9eb8a into autowarefoundation:main Oct 24, 2023
42 checks passed
@SakodaShintaro SakodaShintaro deleted the refactor/change_input_topic_of_gyro_bias_estimator branch October 24, 2023 05:13
kminoda pushed a commit to tier4/autoware.universe that referenced this pull request Nov 7, 2023
…t_pose to ekf_odom (autowarefoundation#5374)

Changed input topic of GyroBiasEstimator from pose to odom

Signed-off-by: Shintaro Sakoda <[email protected]>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants