diff --git a/SLAM/EKFSLAM/animation.gif b/SLAM/EKFSLAM/animation.gif new file mode 100644 index 00000000..c0dbe8f3 Binary files /dev/null and b/SLAM/EKFSLAM/animation.gif differ diff --git a/SLAM/EKFSLAM/ekf_slam.py b/SLAM/EKFSLAM/ekf_slam.py index bc3f00f1..776fb017 100644 --- a/SLAM/EKFSLAM/ekf_slam.py +++ b/SLAM/EKFSLAM/ekf_slam.py @@ -10,6 +10,7 @@ import numpy as np import math import matplotlib.pyplot as plt + # EKF state covariance Cx = np.diag([0.5, 0.5, math.radians(30.0)])**2