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(obstacle_stop_planner): use utils function to caluculate nearest index from ego #651

Conversation

s-azumi
Copy link
Contributor

@s-azumi s-azumi commented Apr 7, 2022

…index from ego

Signed-off-by: Azumi Suzuki azumi.suzuki@tier4.jp

Description

obstalce_stop_planner sometimes not work when driving in overlapping lanes.

When referring to the index on the trajectory closest to the vehicle, it may refer to the opposite trajectory on the overlapping lane.
In which case the obstacle stop function will not work and a crash will occur.

Obstacle stop does not work because it refer to the trajectory in the opposite direction
Screenshot from 2022-04-07 16-15-09

Obstacle stop works if it refer to the correct trajectory
Screenshot from 2022-04-07 16-15-31

In this PR, use existing function that take into account the angle between the vehicle and the trajectory to solve the problem.

Internal PR for tier4:

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.

…index from ego

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>
@s-azumi s-azumi marked this pull request as draft April 7, 2022 09:22
@s-azumi s-azumi changed the title fix(obstacle_stop_planner): use utils function to caluculate nearest … fix(obstacle_stop_planner): use utils function to caluculate nearest index from ego Apr 7, 2022
@s-azumi s-azumi marked this pull request as ready for review April 7, 2022 11:09
Copy link
Contributor

@kosuke55 kosuke55 left a comment

Choose a reason for hiding this comment

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

looks good as code

@codecov
Copy link

codecov bot commented Apr 8, 2022

Codecov Report

Merging #651 (537d5fb) into main (90ee0ae) will decrease coverage by 0.05%.
The diff coverage is 0.00%.

@@            Coverage Diff             @@
##             main     #651      +/-   ##
==========================================
- Coverage   10.72%   10.67%   -0.06%     
==========================================
  Files         729      729              
  Lines       51118    51363     +245     
  Branches     6596     6596              
==========================================
  Hits         5484     5484              
- Misses      41174    41419     +245     
  Partials     4460     4460              
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 10.72% <0.00%> (ø) Carriedforward from 90ee0ae

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

Impacted Files Coverage Δ
planning/obstacle_stop_planner/src/node.cpp 0.00% <0.00%> (ø)

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update 90ee0ae...537d5fb. Read the comment docs.

@takayuki5168 takayuki5168 merged commit 617c1e1 into autowarefoundation:main Apr 8, 2022
@takayuki5168
Copy link
Contributor

@s-azumi please make sure to write release note.

tier4-autoware-public-bot bot referenced this pull request in tier4/autoware.universe Apr 8, 2022
fix(obstacle_stop_planner): use utils function to caluculate nearest index from ego (#651)
@s-azumi s-azumi deleted the fix/obstacle_stop_in_overlapping_lanes branch April 11, 2022 07:01
13304490790 pushed a commit to 13304490790/autoware.universe that referenced this pull request Apr 12, 2022
* split as into pacmod_interface and ssc_interface (autowarefoundation#640)

* split as into pacmod_interface and ssc_interface

* remove as and move config

Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>

* update to support velocity report header (autowarefoundation#655)

* update to support velocity report header

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* Update simulator/simple_planning_simulator/src/simple_planning_simulator/simple_planning_simulator_core.cpp

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* use maybe_unused

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* fix precommit

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>

* adapt to actuation cmd/status as control msg (autowarefoundation#646)

* adapt to actuation cmd/status as control msg

* fix readme

* fix topics

* fix remaing topics

* as to pacmod interface

* fix vehicle status

* add header to twist

* revert gyro_odometer_change

* revert twist topic change

* revert unchanged package

* [pacmod_interface]fix topic name (autowarefoundation#651)

* fix topic name

* fix ns

* fix

* auto/revert cmd converter (autowarefoundation#680)

* Revert "move cmd converters to control pkg (autowarefoundation#642)"

This reverts commit 9f733b5.

* fix topic

* add as doc (autowarefoundation#616)

* add as doc

* pacmod_msgs -> pacmod3_msgs

* fix typo

* update topic names of README.md

* update README.md

Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>

* Auto/steering wheel status (autowarefoundation#719)

* unused

* add stering wheel status

* fix current steer

* publish turn cmd (autowarefoundation#749)

* fix typo

Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Sep 28, 2022
…index from ego (tier4#651)

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…index from ego (tier4#651)

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
…index from ego (tier4#651)

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
…index from ego (tier4#651)

Signed-off-by: Azumi Suzuki <azumi.suzuki@tier4.jp>
soblin pushed a commit to soblin/autoware.universe that referenced this pull request Jul 25, 2023
…ndation#4141) (autowarefoundation#651)

* feat(path_shifter): add utils



* feat(avoidance): shorten avoidance stop distance



* feat(avoidance): insert slow down speed



* fix(avoidance): don't set stoppable=true for objects that ego doesn't have to avoid



* refactor(avoidance): rename unreadable variable name



* docs(avoidance): add new parameter description



---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

3 participants