1 原理
通过对比残差协方差的在线估计值及其理论值来自适应调整过程噪声方差矩阵Qd\mathbf{Q}_{\mathrm{d}}Qd以及测量噪声方差矩阵R\mathbf{R}R,直到残差协方差的估计值和理论值相等。
假定R\mathbf{R}R已知,残差协方差的实际值为
A^=1N∑j=i−N+1irjrjT(1)\widehat{\mathbf{A}}=\frac{1}{N} \sum_{j=i-N+1}^{i} \mathbf{r}_{j} \mathbf{r}_{j}^{\mathrm{T}}\tag{1}A
=N1j=i−N+1∑irjrjT(1)
与其相对应的理论值[H(ti)P(ti−)HT(ti)+R(ti)]\left[\mathbf{H}\left(t_{i}\right) \mathbf{P}\left(t_{i}^{-}\right) \mathbf{H}^{\mathrm{T}}\left(t_{i}\right)+\mathbf{R}\left(t_{i}\right)\right][H(ti)P(ti−)HT(ti)+R(ti)]由卡尔曼滤波器提供。如果A^\widehat{\mathbf{A}}

本文介绍了一种自适应调整卡尔曼滤波器中过程噪声和测量噪声方差矩阵的方法,通过比较残差协方差的在线估计值与理论值来实现。详细解释了如何根据残差特性调整Qd和R,以及在已知其中一个噪声矩阵时如何估计另一个。
最低0.47元/天 解锁文章
1750





