Extended kalman filter (EKF) localization:SLAM核心算法（1）

“”" Extended kalman filter (EKF) localization sample “”" import numpy as np import math import matplotlib.pyplot as plt Estimation parameter of EKF Q = np.diag([0.1, 0.1, np.deg2rad(1.0), 1.0])**2 #

>>阅读原文<<