feat(imu_corrector): add gyro_bias estimation in diag #5054

kminoda · 2023-09-20T10:53:33Z

Description

Add estimated gyro bias in diagnostics.

Tests performed

Launched Autoware and confirmed that the diagnostics are properly updated.

Effects on system behavior

Not applicable

Pre-review checklist for the PR author

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

I've confirmed the contribution guidelines.
The PR follows the pull request guidelines.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

The PR follows the pull request guidelines.

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.

Signed-off-by: kminoda <koji.minoda@tier4.jp>

TaikiYamada4

I tested the rosbag replay simulation in the Autoware tutorial and confirmed the same kind of diagnostics to your test.
LGTM!

codecov · 2023-09-21T05:24:05Z

Codecov Report

Patch coverage has no change and project coverage change: -0.01% ⚠️

Comparison is base (9f4ccf6) 15.75% compared to head (5237356) 15.75%.
Report is 24 commits behind head on main.

Additional details and impacted files

@@            Coverage Diff             @@
##             main    #5054      +/-   ##
==========================================
- Coverage   15.75%   15.75%   -0.01%     
==========================================
  Files        1581     1581              
  Lines      109668   109674       +6     
  Branches    34294    34294              
==========================================
  Hits        17276    17276              
- Misses      73361    73367       +6     
  Partials    19031    19031

Flag	Coverage Δ		*Carryforward flag
differential	`24.70% <0.00%> (?)`
total	`15.75% <ø> (ø)`		Carriedforward from 9f4ccf6

*This pull request uses carry forward flags. Click here to find out more.

Files Changed	Coverage Δ
sensing/imu_corrector/src/gyro_bias_estimator.cpp	`0.00% <0.00%> (ø)`

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* fix(ekf_localizer): fix bug in #5054 Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix bug Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp>

…ation#5066) * fix(ekf_localizer): fix bug in autowarefoundation#5054 Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix bug Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp>

Signed-off-by: asa-naki <akihisa.nagata@tier4.jp>

…tion#4729) (#856) * feat(imu_corrector): add gyro_bias_validator (backport autowarefoundation#4729) * feat(imu_corrector): add gyro_bias_validator Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * revert launch Signed-off-by: kminoda <koji.minoda@tier4.jp> * updat Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * add debug publisher Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor fix Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * style(pre-commit): autofix * add gtest Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * updat e readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * add diagnostics Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * validator -> estimator Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix build Signed-off-by: kminoda <koji.minoda@tier4.jp> * update default parameter Signed-off-by: kminoda <koji.minoda@tier4.jp> * update comment Signed-off-by: kminoda <koji.minoda@tier4.jp> * update readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * updated Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor update in readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * fix pre-commit Signed-off-by: kminoda <koji.minoda@tier4.jp> * update readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * Fix NG -> WARN Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * build(imu_corrector): add missing diagnostic_updater dependency (autowarefoundation#4980) Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp> * add gyro_bias estimation in diag ( autowarefoundation#5054) Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * ci(pre-commit): autofix --------- Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com> Co-authored-by: Esteve Fernandez <33620+esteve@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* feat(system_error_monitor): manual modules (#793) * feat(rviz_plugin): console meter is too large on the Rviz with FHD display, isn't it? (#587) * feat(tier4_planning/vehicle_plugin): make plugins size scalable Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove space Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * scaling Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change diag message Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * fix module name Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * add manual module and ignoring modules Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * Revert "feat(rviz_plugin): console meter is too large on the Rviz with FHD display, isn't it? (#587)" This reverts commit f96169c. * Revert "change diag message" This reverts commit dff01ce. * ci(pre-commit): autofix * fix spell check Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * Revert "fix spell check" This reverts commit 208aa1e. * Revert "fix module name" This reverts commit cec7653. * revert ignore module Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * current_mode check update Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * ci(pre-commit): autofix * delete margin Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> --------- Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> * feat(ad_service_state_monitor): change configs name (#876) change configs name Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * feat(plannig_error_monitor): update error sharp angle threshold (#681) * fix error_sharp_angle Signed-off-by: Shigekazu Fukuta <shigekazu.fukuta@tier4.jp> * update readme Signed-off-by: Shigekazu Fukuta <shigekazu.fukuta@tier4.jp> --------- Signed-off-by: Shigekazu Fukuta <shigekazu.fukuta@tier4.jp> * fix: add error handling when path is invalid (#934) * fix(behavior_path): delete duplicated * add error handling * fix: when path size is 1 * fix(detection_area): search collision index only in lanelet (#695) * fix(detection_area): search collision index only in lanelet * ci(pre-commit): autofix --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> * fix(detection_area): fix overline function (#930) * fix(detection_area): fix overline function * ci(pre-commit): autofix --------- Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> * fix(route_handler): fix threshold for removing overlapping points (#1015) * fix(route_handler): fix threshold for removing overlapping points * fix * fix(ntp_monitor): move chronyc command execution to a timer (backport autowarefoundation#4634) (#880) fix(ntp_monitor): move chronyc command execution to a timer (autowarefoundation#4634) * fix(ntp_monitor): move chronyc command execution to a timer * add newly added parameter timeout to config --------- Signed-off-by: ito-san <fumihito.ito@tier4.jp> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> * feat(elevation_map_loader): add error handling for std::runtime_error (backport autowarefoundation#4187) (#652) feat(elevation_map_loader): add error handling for std::runtime_error (autowarefoundation#4187) * feat(elevation_map_loader): Add error handling for std::runtime_error * feat(elevation_map_loader): add error message output --------- Signed-off-by: Shin-kyoto <58775300+Shin-kyoto@users.noreply.github.com> Co-authored-by: Shintaro Tomie <58775300+Shin-kyoto@users.noreply.github.com> * fix(system_monitor): extend command line to display (backport autowarefoundation#4553) (#768) fix(system_monitor): extend command line to display (autowarefoundation#4553) Signed-off-by: ito-san <fumihito.ito@tier4.jp> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> * fix(system_monitor): high-memory process are not provided in MEM order (backport autowarefoundation#4654) (#769) fix(system_monitor): high-memory process are not provided in MEM order (autowarefoundation#4654) * fix(process_monitor): high-memory process are not being provided in %MEM order * changed option from 'g' to 'n' --------- Signed-off-by: ito-san <fumihito.ito@tier4.jp> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> * fix(system_monitor): fix program command line reading (backport autowarefoundation#5191, autowarefoundation#5430) (#995) * perf(system_monitor): fix program command line reading (autowarefoundation#5191) * Fix program command line reading Signed-off-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> * style(pre-commit): autofix * fix spelling commandline->command_line Signed-off-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> --------- Signed-off-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Co-authored-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> * fix(system_monitor): output command line (autowarefoundation#5430) * fix(system_monitor): output command line Signed-off-by: takeshi.iwanari <takeshi.iwanari@tier4.jp> * style(pre-commit): autofix --------- Signed-off-by: takeshi.iwanari <takeshi.iwanari@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> --------- Signed-off-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Signed-off-by: takeshi.iwanari <takeshi.iwanari@tier4.jp> Co-authored-by: Yuxuan Liu <619684051@qq.com> Co-authored-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: takeshi-iwanari <takeshi.iwanari@tier4.jp> Co-authored-by: Akihisa Nagata <54956813+asa-naki@users.noreply.github.com> * feat(imu_corrector): add gyro_bias_validator (backport autowarefoundation#4729) (#856) * feat(imu_corrector): add gyro_bias_validator (backport autowarefoundation#4729) * feat(imu_corrector): add gyro_bias_validator Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * revert launch Signed-off-by: kminoda <koji.minoda@tier4.jp> * updat Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * add debug publisher Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor fix Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * style(pre-commit): autofix * add gtest Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * updat e readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * add diagnostics Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * update Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * validator -> estimator Signed-off-by: kminoda <koji.minoda@tier4.jp> * fix build Signed-off-by: kminoda <koji.minoda@tier4.jp> * update default parameter Signed-off-by: kminoda <koji.minoda@tier4.jp> * update comment Signed-off-by: kminoda <koji.minoda@tier4.jp> * update readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * updated Signed-off-by: kminoda <koji.minoda@tier4.jp> * minor update in readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * fix pre-commit Signed-off-by: kminoda <koji.minoda@tier4.jp> * update readme Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * Fix NG -> WARN Signed-off-by: kminoda <koji.minoda@tier4.jp> --------- Signed-off-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * build(imu_corrector): add missing diagnostic_updater dependency (autowarefoundation#4980) Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp> * add gyro_bias estimation in diag ( autowarefoundation#5054) Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * ci(pre-commit): autofix --------- Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com> Co-authored-by: Esteve Fernandez <33620+esteve@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> * feat(imu_corrector): add gyro bias log (#918) add gyro_bias log Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * feat(system_error_monitor): add ignore_until_waiting_for_route module (#888) * add ignore_module Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * add description Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * ci(pre-commit): autofix * change name ignore_until_waiting_for_route Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * update description Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * rename function name and delete planning state Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * update description Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * Update --------- Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> * feat(system_error_monitor): add ignore hartbeat timeout in initializing state (#972) * add ignore hartbeat timeout in initializing state Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> * fix typo * Update comment * ci(pre-commit): autofix * fix typo * ci(pre-commit): autofix * update comment * ci(pre-commit): autofix --------- Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> --------- Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: asa-naki <akihisa.nagata@tier4.jp> Signed-off-by: Shigekazu Fukuta <shigekazu.fukuta@tier4.jp> Signed-off-by: ito-san <fumihito.ito@tier4.jp> Signed-off-by: Shin-kyoto <58775300+Shin-kyoto@users.noreply.github.com> Signed-off-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Signed-off-by: takeshi.iwanari <takeshi.iwanari@tier4.jp> Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Shigekazu Fukuta <107168699+sfukuta@users.noreply.github.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Shintaro Tomie <58775300+Shin-kyoto@users.noreply.github.com> Co-authored-by: Yuxuan Liu <619684051@qq.com> Co-authored-by: Owen-Liuyuxuan <uken.ryu@tier4.jp> Co-authored-by: takeshi-iwanari <takeshi.iwanari@tier4.jp> Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com> Co-authored-by: Esteve Fernandez <33620+esteve@users.noreply.github.com>

feat(imu_corrector): add gyro_bias estimation in diag

448b373

Signed-off-by: kminoda <koji.minoda@tier4.jp>

kminoda requested review from TaikiYamada4 and YamatoAndo as code owners September 20, 2023 10:53

github-actions bot added the component:sensing Data acquisition from sensors, drivers, preprocessing. (auto-assigned) label Sep 20, 2023

update

5237356

Signed-off-by: kminoda <koji.minoda@tier4.jp>

TaikiYamada4 approved these changes Sep 21, 2023

View reviewed changes

TaikiYamada4 added the tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Sep 21, 2023

kminoda added a commit to kminoda/autoware.universe that referenced this pull request Sep 21, 2023

fix(ekf_localizer): fix bug in autowarefoundation#5054

d671200

Signed-off-by: kminoda <koji.minoda@tier4.jp>

kminoda mentioned this pull request Sep 21, 2023

fix(ekf_localizer): fix bug in #5054 #5066

Merged

4 tasks

kminoda merged commit e2123a2 into autowarefoundation:main Sep 25, 2023
33 of 36 checks passed

kminoda deleted the feat/imu_corrector/add_gyro_bias_in_diag branch September 26, 2023 01:36

asa-naki added a commit to tier4/autoware.universe that referenced this pull request Sep 26, 2023

add gyro_bias estimation in diag ( autowarefoundation#5054)

e1bdf48

Signed-off-by: asa-naki <akihisa.nagata@tier4.jp>

asa-naki mentioned this pull request Sep 26, 2023

feat(imu_corrector): add gyro_bias_validator (backport #4729) tier4/autoware.universe#856

Merged

7 tasks

tier4-autoware-public-bot bot mentioned this pull request Sep 26, 2023

chore: sync upstream tier4/autoware.universe#878

Merged

tier4-autoware-public-bot bot mentioned this pull request Oct 10, 2023

chore: sync beta branch beta/v0.13.0 with tier4/main tier4/autoware.universe#925

Merged

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

feat(imu_corrector): add gyro_bias estimation in diag #5054

feat(imu_corrector): add gyro_bias estimation in diag #5054

kminoda commented Sep 20, 2023 •

edited by TaikiYamada4

Loading

TaikiYamada4 left a comment

codecov bot commented Sep 21, 2023 •

edited

Loading

feat(imu_corrector): add gyro_bias estimation in diag #5054

feat(imu_corrector): add gyro_bias estimation in diag #5054

Conversation

kminoda commented Sep 20, 2023 • edited by TaikiYamada4 Loading

Description

Tests performed

Effects on system behavior

Pre-review checklist for the PR author

In-review checklist for the PR reviewers

Post-review checklist for the PR author

TaikiYamada4 left a comment

Choose a reason for hiding this comment

codecov bot commented Sep 21, 2023 • edited Loading

Codecov Report

kminoda commented Sep 20, 2023 •

edited by TaikiYamada4

Loading

codecov bot commented Sep 21, 2023 •

edited

Loading