外观
踩坑Robotics Stack Exchange2023-11-16
EKF-SLAM新地标协方差如何初始化
本文由 AI 根据公开内容整理，可能有误，请以原文为准：the uncertainty of initializing new landmark in EKF-SLAM（Robotics Stack Exchange #4599）
状态：已解决
问题
在基于特征地图的 EKF-SLAM 中，新观测地标加入状态向量后，若协方差相关项设为零，地标估计误差不随时间变化；若设很大，重观测会改善但误差趋于固定值。
环境
SLAM 建图与定位系统
解决办法
- 使用逆观测模型
g^{-1}(x, z)根据当前状态估计和观测生成新地标状态。 - 分别计算
g^{-1}对状态x和观测z的雅可比G_x、G_z。 - 扩展状态为
[x; g^{-1}(x, z)]。 - 按块初始化协方差：右上为
P_k G_x^T，左下为G_x P_k，右下为G_x P_k G_x^T + G_z R_k G_z^T，其中R_k为观测方差或协方差。
原问题作者：CroCo；采纳答案作者：kamek。原内容依 CC BY-SA 4.0 授权，本页摘要同样依 CC BY-SA 4.0 授权。
来源
本页事实对应的公开页面，以原文为准。