diff --git a/PathPlanning/Dijkstra/dijkstra.py b/PathPlanning/Dijkstra/dijkstra.py index f5a4703910..2fee6e928d 100644 --- a/PathPlanning/Dijkstra/dijkstra.py +++ b/PathPlanning/Dijkstra/dijkstra.py @@ -143,7 +143,7 @@ def calc_xy_index(self, position, minp): return round((position - minp) / self.resolution) def calc_index(self, node): - return (node.y - self.min_y) * self.x_width + (node.x - self.min_x) + return node.y * self.x_width + node.x def verify_node(self, node): px = self.calc_position(node.x, self.min_x)