try to fix

Author: maoyifei

GEMstack/onboard/planning/parking_route_planner.py

@@ -350,12 +350,12 @@ def is_successfully_parked(self, final_state: List[float], goal_pose: ObjectPose
         # Create a polygon from the parking spot vertices
         # The vertices should be ordered in a way that forms a proper rectangle
         # [bottom-left, top-left, top-right, bottom-right]
-        ordered_vertices = [
-            parking_spot_vertices[0],  # bottom-left
-            parking_spot_vertices[2],  # top-left
-            parking_spot_vertices[3],  # top-right
-            parking_spot_vertices[1],  # bottom-right
-        ]
+        # ordered_vertices = [
+        #     parking_spot_vertices[0],  # bottom-left
+        #     parking_spot_vertices[2],  # top-left
+        #     parking_spot_vertices[3],  # top-right
+        #     parking_spot_vertices[1],  # bottom-right
+        # ]
 
         # First check if vehicle collides with any cone
         for cone_object in cone_objects:
@@ -416,12 +416,12 @@ def is_final_pose_inside(self, final_state: List[float], obstacles: Dict[str, Ob
         # Create a polygon from the parking spot vertices
         # The vertices should be ordered in a way that forms a proper rectangle
         # [bottom-left, top-left, top-right, bottom-right]
-        ordered_vertices = [
-            parking_spot_vertices[0],  # bottom-left
-            parking_spot_vertices[2],  # top-left
-            parking_spot_vertices[3],  # top-right
-            parking_spot_vertices[1],  # bottom-right
-        ]
+        # ordered_vertices = [
+        #     parking_spot_vertices[0],  # bottom-left
+        #     parking_spot_vertices[2],  # top-left
+        #     parking_spot_vertices[3],  # top-right
+        #     parking_spot_vertices[1],  # bottom-right
+        # ]
 
         # Check if final position is within parking spot
         if collisions.point_in_polygon_2d(final_pos_point, cone_vertices):