Skip to content

Commit 8411bdb

Browse files
committed
fix(avoidance): apply logic only for non-parked vehicle
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
1 parent cb73f80 commit 8411bdb

File tree

1 file changed

+4
-4
lines changed
  • planning/behavior_path_avoidance_module/src

1 file changed

+4
-4
lines changed

planning/behavior_path_avoidance_module/src/utils.cpp

+4-4
Original file line numberDiff line numberDiff line change
@@ -676,15 +676,15 @@ bool isNeverAvoidanceTarget(
676676
if (object.behavior == ObjectData::Behavior::MERGING) {
677677
object.reason = "MergingToEgoLane";
678678
if (
679-
isOnRight(object) &&
679+
isOnRight(object) && !object.is_parked &&
680680
object.overhang_points.front().first > parameters->th_overhang_distance) {
681681
RCLCPP_DEBUG(
682682
rclcpp::get_logger(__func__),
683683
"merging vehicle. but overhang distance is larger than threshold.");
684684
return true;
685685
}
686686
if (
687-
!isOnRight(object) &&
687+
!isOnRight(object) && !object.is_parked &&
688688
object.overhang_points.front().first < -1.0 * parameters->th_overhang_distance) {
689689
RCLCPP_DEBUG(
690690
rclcpp::get_logger(__func__),
@@ -696,15 +696,15 @@ bool isNeverAvoidanceTarget(
696696
if (object.behavior == ObjectData::Behavior::DEVIATING) {
697697
object.reason = "DeviatingFromEgoLane";
698698
if (
699-
isOnRight(object) &&
699+
isOnRight(object) && !object.is_parked &&
700700
object.overhang_points.front().first > parameters->th_overhang_distance) {
701701
RCLCPP_DEBUG(
702702
rclcpp::get_logger(__func__),
703703
"deviating vehicle. but overhang distance is larger than threshold.");
704704
return true;
705705
}
706706
if (
707-
!isOnRight(object) &&
707+
!isOnRight(object) && !object.is_parked &&
708708
object.overhang_points.front().first < -1.0 * parameters->th_overhang_distance) {
709709
RCLCPP_DEBUG(
710710
rclcpp::get_logger(__func__),

0 commit comments

Comments
 (0)