Small refactor pt 2

UBCSailbot · Jan 25, 2024 · a9c1650 · a9c1650
1 parent 0ba9025
commit a9c1650
Showing 1 changed file with 3 additions and 3 deletions.
diff --git a/local_pathfinding/ompl_path.py b/local_pathfinding/ompl_path.py
@@ -89,12 +89,12 @@ def get_waypoints(self) -> List[HelperLatLon]:
             return []
 
         solution_path = self._simple_setup.getSolutionPath()
-        referenceLatlon = cs.LatLon(*self.state.goal_state)
+        reference_latlon = cs.LatLon(*self.state.goal_state)
         waypoints = []
 
         for state in solution_path.getStates():
-            waypoint_XY = cs.XY(*(state.getX(), state.getY()))
-            waypoint_latlon = cs.xy_to_latlon(referenceLatlon, waypoint_XY)
+            waypoint_XY = cs.XY(state.getX(), state.getY())
+            waypoint_latlon = cs.xy_to_latlon(reference_latlon, waypoint_XY)
             waypoints.append(
                 HelperLatLon(
                     latitude=waypoint_latlon.latitude, longitude=waypoint_latlon.longitude