From 78b9679049fdf7f7d18cf539b905b6c23c99152f Mon Sep 17 00:00:00 2001 From: hoangson02 Date: Mon, 6 Apr 2026 02:44:45 +0000 Subject: [PATCH] update --- src/custom_planner.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/custom_planner.cpp b/src/custom_planner.cpp index 3db0155..8dc515d 100755 --- a/src/custom_planner.cpp +++ b/src/custom_planner.cpp @@ -1164,7 +1164,7 @@ namespace custom_planner return a; }; - double delta_angle = std::fabs(std::fabs(normalizeAngle(yaw_goal)) - std::fabs(normalizeAngle(angle))); + double delta_angle = std::fabs(normalizeAngle(yaw_goal) - normalizeAngle(angle)); robot::log_warning("DEBUG 3: yaw_goal: %f, angle: %f, delta_angle: %f", yaw_goal, angle, delta_angle); return (delta_angle > (0.5 * M_PI)); }