diff --git a/PathPlanning/Dijkstra/dijkstra.py b/PathPlanning/Dijkstra/dijkstra.py index 509507db..91956049 100644 --- a/PathPlanning/Dijkstra/dijkstra.py +++ b/PathPlanning/Dijkstra/dijkstra.py @@ -50,7 +50,7 @@ def dijkstra_planning(sx, sy, gx, gy, ox, oy, reso, rr): # print("current", current) # show graph - plt.plot(current.x, current.y, "xc") + plt.plot(current.x * reso, current.y * reso, "xc") if len(closedset.keys()) % 10 == 0: plt.pause(0.001) matplotrecorder.save_frame() @@ -86,12 +86,12 @@ def dijkstra_planning(sx, sy, gx, gy, ox, oy, reso, rr): openset[n_id] = node # generate final course - rx, ry = [ngoal.x], [ngoal.y] + rx, ry = [ngoal.x * reso], [ngoal.y * reso] pind = ngoal.pind while pind != -1: n = closedset[pind] - rx.append(n.x) - ry.append(n.y) + rx.append(n.x * reso) + ry.append(n.y * reso) pind = n.pind return rx, ry