fix(goal_planner): fix updateCollisionCheckDebugMap timing in checkSa…

…fetyWithIntegralPredictedPolygon (#6413)

Signed-off-by: kosuke55 <[email protected]>

planning/behavior_path_planner_common/src/utils/path_safety_checker/safety_check.cpp

@@ -543,9 +543,9 @@ bool checkSafetyWithIntegralPredictedPolygon(
           updateCollisionCheckDebugMap(debug_map, debug_pair, /*is_safe=*/false);
           return false;
         }
-        updateCollisionCheckDebugMap(debug_map, debug_pair, /*is_safe=*/true);
       }
     }
+    updateCollisionCheckDebugMap(debug_map, debug_pair, /*is_safe=*/true);
   }
   return true;
 }