autowarefoundation / autoware.universe

https://autowarefoundation.github.io/autoware.universe/
Apache License 2.0
1.01k stars 650 forks source link

fix(route_handler): creating route at parking lot #8906

Open ismetatabay opened 2 months ago

ismetatabay commented 2 months ago

Description

At current autoware, the parking scenario cannot initiate sometimes due to route cannot be planned between ego lanelet and closest lanelet to goal pose. However since ego vehicle and goal pose in same parking lot area, we don't need to reject goal due to path planning.

This PR checks whether the start and goal poses are in the same parking lot and sends the start lanelet as the path to initiate other nodes, as a full path is not necessary for freespace planning.

Related links

Parent Issue:

How was this PR tested?


Map File

lanelet2_map.txt


Psim

Before this PR:

https://github.com/user-attachments/assets/e16144b2-a98b-4269-bf01-83df67382a8e

After this PR:

https://github.com/user-attachments/assets/0b277114-037c-4c8f-be82-bf16c79494c3

Notes for reviewers

None.

Interface changes

None.

Effects on system behavior

autoware_remaining_distance_time_calculator package fails to calculate the time since the package cannot find a route between start and goal lanelet: https://github.com/autowarefoundation/autoware.universe/blob/d57f82d9c57a5384993b38ad3a477df4221ff623/planning/autoware_remaining_distance_time_calculator/src/remaining_distance_time_calculator_node.cpp#L131-L137

I am planning to create another PR to disable time calculation in the parking scenario, as the calculation no required during freespace driving.

github-actions[bot] commented 2 months ago

Thank you for contributing to the Autoware project!

🚧 If your pull request is in progress, switch it to draft mode.

Please ensure: