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

fix(multi_object_tracker): bicycle motion model - set minimum wheel-to-center length #6337

Conversation

technolojin
Copy link
Contributor

Description

When detected object type is cylinder, it has no length.
The current tracker always updates its bounding box dimension, and then update the wheel-to-center lengths.

This fix limits the wheel-to-center lengths lr_ and lf_ to have a minimum values, so that the prediction do not divide very small number.

Tests performed

Tested on Tier4 deployment environment and its data replay.

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.

…ability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
@github-actions github-actions bot added the component:perception Advanced sensor data processing and environment understanding. (auto-assigned) label Feb 6, 2024
Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
@technolojin technolojin self-assigned this Feb 6, 2024
@technolojin technolojin marked this pull request as ready for review February 6, 2024 09:43
@technolojin technolojin added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Feb 6, 2024
@technolojin technolojin enabled auto-merge (squash) February 6, 2024 09:51
Copy link
Contributor

@YoshiRi YoshiRi left a comment

Choose a reason for hiding this comment

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

LGTM

Copy link
Contributor

@yukkysaito yukkysaito left a comment

Choose a reason for hiding this comment

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

LGTM

@technolojin technolojin merged commit 7a53913 into autowarefoundation:main Feb 6, 2024
16 of 17 checks passed
kminoda added a commit to tier4/autoware.universe that referenced this pull request Feb 8, 2024
anhnv3991 pushed a commit to anhnv3991/autoware.universe that referenced this pull request Feb 13, 2024
…o-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
technolojin added a commit to tier4/autoware.universe that referenced this pull request Feb 21, 2024
…o-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
StepTurtle pushed a commit to StepTurtle/autoware.universe that referenced this pull request Feb 28, 2024
…o-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
TomohitoAndo pushed a commit to tier4/autoware.universe that referenced this pull request Mar 11, 2024
…o-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
TomohitoAndo added a commit to tier4/autoware.universe that referenced this pull request Mar 11, 2024
* chore(build): remove tier4_autoware_utils.hpp perception/ (autowarefoundation#4843)

removed tier4_autoware_utils.hpp in perception/

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>

* feat(multi_object_tracker): mot bicycle model revision (autowarefoundation#6082)

* fix: bicycle model length on big vehicle

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: rear axis position fix in all modalities

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: repeat predict to limit dt

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: implement repeating prediction to all modalities

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: bicycle model revision

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: fix centripetal acceleration,  jacobian

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* style(pre-commit): autofix

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: equation on description, velocity index fix

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: markdown math

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: refactor params

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* feat: model slip process rate

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* feat: yaw rate limits

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: refactor vx to vel, follow actual definition

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: acceleration uncertainty equation fix

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: twist covariance matrix

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: explanations of Kalman filter matrices

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* feat: slip angle process noise model revised

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* feat: parameter tuning

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* fix: use mahalanobis distance gate with larger threshold

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align tracker format

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* style(pre-commit): autofix

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Yoshi Ri <yoshiyoshidetteiu@gmail.com>
Co-authored-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>

* fix(multi_object_tracker): bicycle motion model - set minimum wheel-to-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
Co-authored-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com>
Co-authored-by: Taekjin LEE <technolojin@gmail.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Yoshi Ri <yoshiyoshidetteiu@gmail.com>
Co-authored-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…o-center length (autowarefoundation#6337)

* fix: bicycle motion model - set minimum wheel-to-center length for stability

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* chore: align comments

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

---------

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>
@technolojin technolojin deleted the fix/multi-object-tracker-instability-fix branch July 26, 2024 02:21
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:perception Advanced sensor data processing and environment understanding. (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.

3 participants