fix(tier4_planning_rviz_plugin): fix calculation of drivable area bounds (#7815)

beyzanurkaya · KhalilSelyan · commit 9836f2982a22 · 2024-07-22T17:26:27.000+03:00
change angle condition

Signed-off-by: beyza &lt;bnk@leodrive.ai&gt;
diff --git a/common/tier4_planning_rviz_plugin/include/tier4_planning_rviz_plugin/path/display.hpp b/common/tier4_planning_rviz_plugin/include/tier4_planning_rviz_plugin/path/display.hpp
@@ -77,7 +77,7 @@ void visualizeBound(
 
       const float diff_angle =
         autoware::universe_utils::normalizeRadian(normal_vector_angle - curr_to_next_angle);
-      if (diff_angle == 0.0) {
+      if (diff_angle <= 1e-7 && diff_angle >= -1e-7) {
         return std::make_pair(normal_vector_angle, width);
       }
 

Original file line number	Diff line number	Diff line change
`@@ -77,7 +77,7 @@ void visualizeBound(`
`77`	`77`
`78`	`78`	`const float diff_angle =`
`79`	`79`	`autoware::universe_utils::normalizeRadian(normal_vector_angle - curr_to_next_angle);`
`80`		`- if (diff_angle == 0.0) {`
	`80`	`+ if (diff_angle <= 1e-7 && diff_angle >= -1e-7) {`
`81`	`81`	`return std::make_pair(normal_vector_angle, width);`
`82`	`82`	`}`
`83`	`83`