diff --git a/src/adf_core_python/implement/module/algorithm/a_star_path_planning.py b/src/adf_core_python/implement/module/algorithm/a_star_path_planning.py index 8b2741a..120aacf 100644 --- a/src/adf_core_python/implement/module/algorithm/a_star_path_planning.py +++ b/src/adf_core_python/implement/module/algorithm/a_star_path_planning.py @@ -84,6 +84,9 @@ def reconstruct_path( def get_distance(self, from_entity_id: EntityID, to_entity_id: EntityID) -> float: path: list[EntityID] = self.get_path(from_entity_id, to_entity_id) + if not path: + return float("inf") + distance: float = 0.0 for i in range(len(path) - 1): distance += self.distance(path[i], path[i + 1])