fix(avoidance): fix invalid road bound distance calculation (#6781)

satoshi-ota · web-flow · commit 06bb9bdab639 · 2024-04-11T15:38:54.000+09:00
fix(avoidance): fix invalid road shoulder distance calculation

Signed-off-by: satoshi-ota &lt;satoshi.ota928@gmail.com&gt;
diff --git a/planning/behavior_path_avoidance_module/src/utils.cpp b/planning/behavior_path_avoidance_module/src/utils.cpp
@@ -874,8 +874,7 @@ double getRoadShoulderDistance(
       }
 
       {
-        const auto p2 =
-          calcOffsetPose(p_tmp, 0.0, (isOnRight(object) ? -100.0 : 100.0), 0.0).position;
+        const auto p2 = calcOffsetPose(p_tmp, 0.0, (isOnRight(object) ? -1.0 : 1.0), 0.0).position;
         const auto opt_intersect =
           tier4_autoware_utils::intersect(p1.second, p2, bound.at(i - 1), bound.at(i));
 

Original file line number	Diff line number	Diff line change
`@@ -874,8 +874,7 @@ double getRoadShoulderDistance(`
`874`	`874`	`}`
`875`	`875`
`876`	`876`	`{`
`877`		`- const auto p2 =`
`878`		`- calcOffsetPose(p_tmp, 0.0, (isOnRight(object) ? -100.0 : 100.0), 0.0).position;`
	`877`	`+ const auto p2 = calcOffsetPose(p_tmp, 0.0, (isOnRight(object) ? -1.0 : 1.0), 0.0).position;`
`879`	`878`	`const auto opt_intersect =`
`880`	`879`	`tier4_autoware_utils::intersect(p1.second, p2, bound.at(i - 1), bound.at(i));`
`881`	`880`