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(mpc_lateral_controller): precise backward driving #6578

Merged

Conversation

takayuki5168
Copy link
Contributor

@takayuki5168 takayuki5168 commented Mar 9, 2024

Description

When driving backward, the MPC's precision was not good.
This is because the curvature's sign for the delay compensation was wrong when driving backward. This PR fixed the issue.

In the following videos, see the deviation between the planned trajectory and the white line that is MPC's predicted trajectory.
before
https://github.com/autowarefoundation/autoware.universe/assets/20228327/0d366fcd-ed28-4e81-b754-eb2849854bc3

after
https://github.com/autowarefoundation/autoware.universe/assets/20228327/f2d011a8-507e-4182-b715-c7039b2506c8

Tests performed

psim

Effects on system behavior

more precise tracking control when backward driving

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.

Sorry, something went wrong.

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
@github-actions github-actions bot added the component:control Vehicle control algorithms and mechanisms. (auto-assigned) label Mar 9, 2024
@takayuki5168 takayuki5168 added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Mar 9, 2024
@takayuki5168 takayuki5168 requested a review from HansOersted March 9, 2024 10:46
@takayuki5168 takayuki5168 marked this pull request as ready for review March 9, 2024 10:47
@takayuki5168 takayuki5168 requested a review from TakaHoribe as a code owner March 9, 2024 10:47
Copy link

codecov bot commented Mar 9, 2024

Codecov Report

Attention: Patch coverage is 0% with 2 lines in your changes are missing coverage. Please review.

Project coverage is 14.78%. Comparing base (888fec6) to head (7d7b66f).
Report is 21 commits behind head on main.

Files Patch % Lines
control/mpc_lateral_controller/src/mpc.cpp 0.00% 0 Missing and 2 partials ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #6578      +/-   ##
==========================================
- Coverage   14.78%   14.78%   -0.01%     
==========================================
  Files        1917     1917              
  Lines      132012   132008       -4     
  Branches    39228    39221       -7     
==========================================
- Hits        19523    19519       -4     
- Misses      90699    90702       +3     
+ Partials    21790    21787       -3     
Flag Coverage Δ *Carryforward flag
differential 44.94% <0.00%> (?)
total 14.78% <ø> (-0.01%) ⬇️ Carriedforward from 9b5a372

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

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

Copy link
Contributor

@TakaHoribe TakaHoribe left a comment

Choose a reason for hiding this comment

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

...Great! Let's make a tracking performance test in scenario tests later.

@takayuki5168 takayuki5168 merged commit ef751f6 into autowarefoundation:main Mar 11, 2024
48 of 51 checks passed
@takayuki5168 takayuki5168 deleted the fix/mpc-backward-precise branch March 11, 2024 02:56
HansRobo pushed a commit that referenced this pull request Mar 12, 2024
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Kotaro Yoshimoto <pythagora.yoshimoto@gmail.com>
kaigohirao pushed a commit to kaigohirao/autoware.universe that referenced this pull request Mar 22, 2024
…tion#6578)

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: kaigohirao <kaigo.hirao@proxima-ai-tech.com>
karishma1911 pushed a commit to Interplai/autoware.universe that referenced this pull request Jun 3, 2024
…tion#6578)

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:control Vehicle control algorithms and mechanisms. (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.

None yet

3 participants