diff --git a/examples/gps_fusion.py b/examples/gps_fusion.py index a88d1a4..15d611a 100644 --- a/examples/gps_fusion.py +++ b/examples/gps_fusion.py @@ -22,7 +22,7 @@ def run(kalman_filter_t): # Kalman Filter parameter definition x0 = [100, 50] - P0 = [[10, 0], [0, 5]] + P0 = [[1000, 0], [0, 400]] H = [[1, 0], [0, 1]] Q = [[0.2, 0], [0, 2]] F = [[1, 1], [0, 1]] @@ -61,11 +61,11 @@ def run(kalman_filter_t): disp.move_object("ground_truth", [x_actual[:, 0][t], 0]) disp.set_circle_radius("ground_truth", 0) - disp = Displayer(width=6, height=6, frame_interval=100) + disp = Displayer(width=6, height=6, frame_interval=150) disp.set_axis_limits(xlim=[0, 1000], ylim=[-500, 500]) disp.register_object("measurement", "red") disp.register_object("estimate", "blue") disp.register_object("ground_truth", "green") - disp.animate(n_steps=n_iterations, anim_callback=update) \ No newline at end of file + disp.animate(n_steps=n_iterations, anim_callback=update)