自主导航系列11-理论补充
1,robot_pose_ekf
核心是使用扩展的卡尔曼滤波器
// 根据以上建立一个新的高斯分布,再用这个高斯分布建立新的扩展卡尔曼滤波器 prior_ = new Gaussian(prior_Mu,prior_Cov); filter_ = new ExtendedKalmanFilter(prior_);
2,仿真
参考古月居的教程
核心是使用扩展的卡尔曼滤波器
// 根据以上建立一个新的高斯分布,再用这个高斯分布建立新的扩展卡尔曼滤波器 prior_ = new Gaussian(prior_Mu,prior_Cov); filter_ = new ExtendedKalmanFilter(prior_);
参考古月居的教程