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): cherry pick diagnostics modification in gyro_bias_estimatior from awf #1122

Merged
merged 1 commit into from
Jan 30, 2024

Conversation

TaikiYamada4
Copy link

Description

Make the diagnostics publication from gyro_bias_estiamator constant.
The default period is 0.5 seconds.
You can change this in gyro_bias_estimator.param.yaml but note that the period will be min(timer_callback_interval_sec, diagnostics_updater_interval_sec).

Cherry-pick from the autowarefoundation/autoware.universe autowarefoundation#6139

Tests performed

I've test this code via rosbag replay simulation tutorial.

Effects on system behavior

/diagnostics from gyro_bias_estimator should be more periodical than before
The content of the /diagnostics will be changed as mentioned in autowarefoundation#6139

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.

…agnostics in gyro_bias_estimator (autowarefoundation#6139)

* Let diagnostics be updated even if expections occur in timer_callback

Signed-off-by: TaikiYamada4 <[email protected]>

* Fixed the summary message to be "Not updated" when the gyro bias is not updated.
Fixed typo.

Signed-off-by: TaikiYamada4 <[email protected]>

* Removed force_update() since updater_ originaly updates diagnostics automatically.
Set the update peirod of diagnostics to be same to the timer_callback.
Changed words of the diagnostics message a bit.

Signed-off-by: TaikiYamada4 <[email protected]>

* style(pre-commit): autofix

* Let the period of diagnostics publication independent to timer.
Let update_diagnostics to be simple.

Signed-off-by: TaikiYamada4 <[email protected]>

* style(pre-commit): autofix

* Fixed typo

Signed-off-by: TaikiYamada4 <[email protected]>

* style(pre-commit): autofix

* Added setPeriod after force_update to reset the timer of updater_.
Then, there will be no duplicates of diagnostics.

Signed-off-by: TaikiYamada4 <[email protected]>

* style(pre-commit): autofix

* Set diagnostics values to have the same precision
Added gyro_bias_threshold_ to the diagnostics

Signed-off-by: TaikiYamada4 <[email protected]>

* Updated README.md to match the paramters in gyro_bias_estimator

Signed-off-by: TaikiYamada4 <[email protected]>

* style(pre-commit): autofix

---------

Signed-off-by: TaikiYamada4 <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Copy link
Collaborator

@shmpwk shmpwk left a comment

Choose a reason for hiding this comment

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

LGTM

@TaikiYamada4 TaikiYamada4 marked this pull request as ready for review January 30, 2024 02:16
@shmpwk shmpwk merged commit 7021f0a into beta/v0.20.1 Jan 30, 2024
17 of 18 checks passed
@shmpwk shmpwk deleted the hotfix/v0.20.1/gyro_bias_estimator_diag branch January 30, 2024 02:18
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants