|
|
@@ -16,8 +16,8 @@ END = 200.0
|
|
|
|
|
|
fig, ax1 = plt.subplots(1, 1)
|
|
|
# fig, (ax1, ax2) = plt.subplots(1, 2, figsize=(15, 7))
|
|
|
-ax1.set_xlim((-0.45, 0.45))
|
|
|
-ax1.set_ylim((-0.35, 0.55))
|
|
|
+ax1.set_xlim((-.45, .45))
|
|
|
+ax1.set_ylim((-.35, .55))
|
|
|
# ax1.set_xlim((0, 100))
|
|
|
# ax1.set_ylim((-0.07, 0.1))
|
|
|
# ax2.set_xlim((0, END))
|
|
|
@@ -26,7 +26,7 @@ ax1.set_ylim((-0.35, 0.55))
|
|
|
# ax1.set_title("Trajectory")
|
|
|
# ax2.set_title("Accumulated Offset")
|
|
|
|
|
|
-cbd = AGVVirtual("AGVVirtual", initial=[0, -0.3, 0], Kp=0.06, Ki=0.0, Kd=0.05)
|
|
|
+cbd = AGVVirtual("AGVVirtual", path_file="paths/falcon.csv", initial=[0, -.3, 0], Kp=0.06, Ki=0.0, Kd=0.05)
|
|
|
# cbd = AGVVirtual("AGVVirtual", initial=[0, -0.3, PI], Kp=Kp, Ki=Ki, Kd=Kd)
|
|
|
# cbd = Test("Test")
|
|
|
|
|
|
@@ -53,7 +53,7 @@ manager.connect("heading", 'preupdate', update_arrow)
|
|
|
|
|
|
# Run the Simulation
|
|
|
sim = Simulator(cbd)
|
|
|
-sim.setRealTime(scale=1)
|
|
|
+sim.setRealTime(scale=.1)
|
|
|
sim.setProgressBar()
|
|
|
sim.setDeltaT(DELTA_T)
|
|
|
sim.connect("finished", lambda: manager.stop())
|