8维非线性问题无迹卡尔曼滤波(UKF)负协方差矩阵异常咨询
8维UKF协方差出现负值的核心原因定位
- 权重体系完全错配
代码手动推导了Wc、Wm权重,但后续调用unscented_transform计算预测、测量协方差时,传入的是MerweScaledSigmaPoints类自带的权重;计算状态-测量交叉协方差Pfh时又改用手动定义的Wc,两套权重参数不统一,直接导致协方差计算结果完全失真。 - 权参数选择不当引入大绝对值负权重,破坏协方差正定性
按当前参数n=8、alpha=0.1、kappa=0计算,得到无迹变换的尺度因子lambda = alpha²*(n+kappa) -n = -7.92,对应首个sigma点的权重Wm[0] = -99,是绝对值极大的负权重。同时n+lambda=0.08的取值过小,导致sigma点离均值的距离过近,无法有效捕捉状态函数的非线性变化。无迹变换的协方差本质是加权外积和,负权重的存在极易因数值精度问题导致协方差矩阵失去半正定性,直接出现负对角元素。 - 预测步漏加过程噪声
Q
代码完成sigma点经非线性状态函数变换后的协方差计算后,未将提前定义的过程噪声矩阵Q加到预测协方差ukf_f_cov中,导致预测协方差被过度低估,后续更新步做减法运算时极易出现负值。 - 更新步公式书写错误,漏加测量噪声
R
标准UKF更新步的协方差计算逻辑为:先计算测量协方差矩阵
S = P_zz + R,再求解卡尔曼增益K = P_xz @ inv(S),最终更新协方差P_new = P_pred - K @ S @ K.T
你的代码中既未将测量噪声R加到测量协方差ukf_h_cov中,协方差更新公式也写为New_covarince = ukf_f_cov - np.dot(K,ukf_h_cov).dot(K.T),计算逻辑完全不符合标准UKF流程,直接导致协方差结果错误。 - 残差幅度过大加剧修正失真
先验状态经过一步预测后,T2、T3的量级仍在20~30区间,但代码中给定的测量值h为[47.396, 55.423],和预测得到的测量均值差幅超过100%,过大的残差会推高卡尔曼增益的修正幅度,进一步放大协方差计算的失真问题。 - 冗余代码问题
代码中生成的Q_n、R_n两个随机多元正态分布样本全程未参与计算,对算法逻辑无实际作用,属于无意义的冗余操作。
内容的提问来源于stack exchange,提问作者Hami
相关产品推荐
相关产品推荐

