-
Notifications
You must be signed in to change notification settings - Fork 663
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(dynamic_avoidance): avoid pedestrians #6553
Conversation
055e68c
to
5945f7f
Compare
NOT_TO_AVOID = 0, | ||
LaneDriveObject, | ||
FreeRunObject, |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
FreeRunObject is hard to understand.
The best enum would be ObjectType
which includes
- Vehicle
- Technically, bicycles should be included, but in our case, not included.
- NotVehicle
, and the getter function's output is std::optional<ObjectType>
to deal with objects not to avoid.
Or if you wanna add the ego's behavior to the enum, the enum would be ObjectBehaviorType
which includes
- Ignore
- AvoidVehicleObject
- AvoidNotVehicleObject
I don't come up with a good name.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Thank you.
I'll think these names again after the polygon generation algorithm is decided
...avior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp
Outdated
Show resolved
Hide resolved
...avior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp
Outdated
Show resolved
Hide resolved
...avior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp
Outdated
Show resolved
Hide resolved
e793646
to
e85d5f9
Compare
geometry_msgs::msg::Pose pose{}; | ||
double pose_covariance_sqrt[36]; // for experimental |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
for experimental?
pose_covariance_sqrt[i] = | ||
std::sqrt(predicted_object.kinematics.initial_pose_with_covariance.covariance[i]); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
If you're gonna keep this line, please use squared value instead of square root value for the computation cost
enum class ObjectBehaviorType { | ||
IGNORE = 0, | ||
REGULATED, | ||
PRIORITIZED, | ||
}; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
The subject of IGNORE is the ego, but that of REGULATED/PRIORITIZED is the object? They should be the same.
Also, what do you mean by PRIORITIZED in this enum.
5bd8b11
to
8952ac1
Compare
25afbe9
to
009d182
Compare
...avior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp
Outdated
Show resolved
Hide resolved
@@ -1403,6 +1669,7 @@ DynamicAvoidanceModule::calcEgoPathBasedDynamicObstaclePolygon( | |||
return obj_poly; | |||
} | |||
|
|||
// TODO (takagi): replace by the nother function? |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
// TODO (takagi): replace by the nother function? | |
// TODO (takagi): replace by the another function? |
...avior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp
Outdated
Show resolved
Hide resolved
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
Signed-off-by: Yuki Takagi <[email protected]>
4aacd0e
to
9698e8d
Compare
Signed-off-by: Yuki Takagi <[email protected]>
e5b3f60
into
autowarefoundation:main
new feature: avoid against the pedestrians Signed-off-by: Yuki Takagi <[email protected]>
feat(dynamic_avoidance): avoid pedestrians autowarefoundation#6553
new feature: avoid against the pedestrians Signed-off-by: Yuki Takagi <[email protected]>
Description
New feature
Avoid against pedestrians becomes available.
Selection algorithms is similar to the conventional logic for vehicles.
Polygon generation logic is significant different from the the conventional logic.
For more details, please see the updated document
https://autowarefoundation.github.io/autoware.universe/pr-6553/planning/behavior_path_dynamic_avoidance_module/#cuts-off-the-drivable-area-against-the-selected-pedestrians
Sample videos
Screencast from 04-08-2024 07:13:23 PM.webm
Screencast from 04-08-2024 07:31:41 PM.webm
Screencast from 04-12-2024 02:53:38 PM.webm
Related links
launch PR: autowarefoundation/autoware_launch#958
Tests performed
Psim tests and tier4 internal tests were performed.
Notes for reviewers
Interface changes
Nothing
Effects on system behavior
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.
After all checkboxes are checked, anyone who has write access can merge the PR.