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(ndt_scan_matcher): change coordinate of output_pose_covariance #6065

Conversation

YamatoAndo
Copy link
Contributor

Description

I would like to change the handling of output_pose_covariance param from the map coordinate system to the base_link coordinate system.
Along with this, a feature to convert output_pose_covariance to the map coordinate system based on the estimated pose has been added.

Tests performed

  • LSim works as usual.
    ※ The output covariance of NDT have changed slightly, so it is not exactly the same as before.

  • When output_pose_covariance is modified, the output covariance becomes aligned with the estimated pose.

example

    output_pose_covariance:
      [
        30.0, 0.0,   0.0,   0.0,      0.0,      0.0,
        0.0,   10.0, 0.0,   0.0,      0.0,      0.0,
        0.0,   0.0,   0.0225, 0.0,      0.0,      0.0,
        0.0,   0.0,   0.0,   0.000625, 0.0,      0.0,
        0.0,   0.0,   0.0,   0.0,      0.000625, 0.0,
        0.0,   0.0,   0.0,   0.0,      0.0,      0.000625,
      ]

Screenshot from 2024-01-12 19-41-49

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.

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:localization Vehicle's position determination in its environment. (auto-assigned) label Jan 12, 2024
Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
@YamatoAndo YamatoAndo force-pushed the feat/ndt_scan_matcher_rotate_covariace branch from 5f1ac7c to 1771792 Compare January 12, 2024 10:55
Copy link
Contributor

@KYabuuchi KYabuuchi left a comment

Choose a reason for hiding this comment

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

We can replace some variables with const variables, please fix. 🙏
The rest of them are fine. 🙆‍♂️

Copy link
Contributor

@KYabuuchi KYabuuchi left a comment

Choose a reason for hiding this comment

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

LGTM 🙆‍♂️

@YamatoAndo YamatoAndo added the tag:run-build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Jan 15, 2024
@YamatoAndo YamatoAndo merged commit a3f90f0 into autowarefoundation:main Jan 16, 2024
25 of 27 checks passed
Motsu-san pushed a commit to tier4/autoware.universe that referenced this pull request Feb 28, 2024
…utowarefoundation#6065)

* feat(ndt_scan_matcher): change coordinate of output_pose_covariance

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>

* style(pre-commit): autofix

* Update localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>
Signed-off-by: Motsu-san <masahiro.sakamoto@tier4.jp>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 26, 2024
…utowarefoundation#6065)

* feat(ndt_scan_matcher): change coordinate of output_pose_covariance

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>

* style(pre-commit): autofix

* Update localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 28, 2024
…utowarefoundation#6065)

* feat(ndt_scan_matcher): change coordinate of output_pose_covariance

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>

* style(pre-commit): autofix

* Update localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request May 28, 2024
…utowarefoundation#6065)

* feat(ndt_scan_matcher): change coordinate of output_pose_covariance

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>

* style(pre-commit): autofix

* Update localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…utowarefoundation#6065)

* feat(ndt_scan_matcher): change coordinate of output_pose_covariance

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>

* style(pre-commit): autofix

* Update localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: yamato-ando <yamato.ando@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kento Yabuuchi <moc.liamg.8y8@gmail.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:localization Vehicle's position determination in its environment. (auto-assigned) tag: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