自适应卡尔曼滤波的多种形式

在卡尔曼滤波量测更新过程中,按照平差中的数学模型分为函数模型和随机模型,那么动力学方法和观测方程均为函数模型,P和R矩阵的确定则为随机模型的建立。

对于P矩阵来说,其核心思想在于重用当前时刻观测值。在融合初始化过程中,我们会对P矩阵进行初始化,之后随状态更新和量测更新而更新,一旦预测状态或者观测值突然出现问题,经验随机模型无法描述这种误差。

因此,研究者们提出了自适应滤波,使得滤波更相信当前时刻的观测(这也是合理的,对于观测是否合理则采用抗差滤波的方式),进而补偿P这部分随机模型误差。随之,遗忘滤波、渐消记忆滤波和自适应滤波逐渐发展,但是这些滤波容易混淆。本文将对四种形式的自适应滤波进行系统的总结,按照自适应因子的构建分为遗忘滤波、渐消记忆滤波、自适应滤波、sage-husa自适应滤波。前三种都需要构建自适应因子(遗忘因子、渐消记忆因子和自适应因子),最后一种则采用开窗平均的方法代替自适应因子的构建。

注意:其实遗忘因子是渐消记忆因子的另一种叫法,但是本文根据不同模型将遗忘因子和渐消记忆因子进行了区分,可以看成把简单问题复杂化了吧,而且遗忘因子/渐消记忆因子的求解也不止这两种方法。

目录

  • 自适应卡尔曼滤波的多种形式
  • 经典卡尔曼滤波
  • 遗忘滤波
  • 渐消记忆滤波
  • 自适应滤波
  • Sage-Husa自适应滤波
  • 1 经典卡尔曼滤波
  • 2 遗忘滤波
  • 3 渐消记忆滤波
  • 4 自适应滤波
    • 4.1 误差判别统计量
      • 4.1.1 状态不符值统计量
      • 4.1.2 速度不符值统计量
      • 4.1.3 预测残差统计量
      • 4.1.4 方差分量比统计量
    • 4.2 自适应因子
      • 4.2.1 三段式自适应因子
      • 4.2.2 二段式自适应因子
      • 4.2.3 指数函数表示的自适应因子
      • 4.2.4 选权法表示的自适应因子
  • 5 Sage-Husa自适应滤波
    • 5.1 观测噪声协方差矩阵的开窗估计
    • 5.2 动态模型噪声矩阵的开窗估计
  • 参考文献

经典卡尔曼滤波

遗忘滤波

渐消记忆滤波

自适应滤波

Sage-Husa自适应滤波

1 经典卡尔曼滤波

推导过程不再细述,直接上公式

系统动力学方程和观测方程(平差中的函数模型):
xk=Akx^k−1+wk(1)x_k=A_k\hat x_{k-1}+w_k\tag{1}xk​=Ak​x^k−1​+wk​(1)
zk=Hkxk+vk(2)z_k=H_kx_k+v_k\tag{2}zk​=Hk​xk​+vk​(2)

状态更新方程:
xk=Akx^k−1(3)x_k=A_k\hat x_{k-1}\tag{3}xk​=Ak​x^k−1​(3)
Pk=AkP^k−1AkT+Qk(4)P_k=A_k\hat P_{k-1}A_k^T+Q_k\tag{4}Pk​=Ak​P^k−1​AkT​+Qk​(4)

量测更新方程:
Kk=PkHkT(HkPkHkT+Rk)−1(5)K_k=P_kH_k^T(H_kP_kH_k^T+R_k)^{-1}\tag{5}Kk​=Pk​HkT​(Hk​Pk​HkT​+Rk​)−1(5)
x^k=xk+Kk(Zk−Hkxk)(6)\hat x_k=x_k+K_k(Z_k-H_kx_k)\tag{6}x^k​=xk​+Kk​(Zk​−Hk​xk​)(6)
P^k=(I−KkHk)Pk(7)\hat P_k=(I-K_kH_k)P_k\tag{7}P^k​=(I−Kk​Hk​)Pk​(7)

式中,QkQ_kQk​和RkR_kRk​分别是wkw_kwk​和vkv_kvk​的协方差矩阵,两种噪声互不相关。在每个历元进行状态更新,每个观测历元进行量测更新,形成时间上的迭代估计最优状态。

2 遗忘滤波

遗忘滤波相比经典卡尔曼滤波多了遗忘因子,记为λ\lambdaλ,改进公式(4)为公式(8)
Pk=Ak1λP^k−1AkT+Qk(8)P_k=A_k\frac{1}{\lambda}\hat P_{k-1}A_k^T+Q_k\tag{8}Pk​=Ak​λ1​P^k−1​AkT​+Qk​(8)
其中遗忘因子λ\lambdaλ为一常数,取值0.95-0.995。

遗忘因子通过修改先验协方差矩阵PkP_kPk​,调节当前历元中预测和量测之间的权比关系。遗忘因子设置越大,则前一历元先验协方差矩阵Pk−1P_{k-1}Pk−1​越接近传统卡尔曼滤波后验协方差矩阵P^k−1\hat P_{k-1}P^k−1​,预测和量测之间权比关系越接近没有改变,特殊情况λ=1\lambda=1λ=1;反之,遗忘因子设置的越小,那么当前历元先验协方差矩阵PkP_{k}Pk​就会越大,使得卡尔曼滤波增益矩阵Kk+1K_{k+1}Kk+1​越大,越相信下当前时刻的量测。也就是说,新数据(观测值)的权重要大于历史数据(预测值)。
总结一下,遗忘因子的作用在于通过调节协方差矩阵,权衡预测状态和观测值的权重,遗忘因子一般大于1。

但是,遗忘因子存在一定的缺陷,因为采用的是常值遗忘因子,无法适应环境变化;其次,人为降低历史状态信息,在预测准确而量测不准确的情况下,得到效果不好。因此,有学者对探究对遗忘因子常值取指数的方法,(1λ)N−k{(\frac{1}{\lambda})}^{N-k}(λ1​)N−k,N是一个参考时刻,要大于k,k为当前历元数目,通过指数遗忘因子可以看出,距离N越远,则遗忘因子越大,预测越不可靠,但是理论推导也不是很严谨,也存在预测准确量测不准确时面临的问题。

3 渐消记忆滤波

渐消记忆滤波构造了渐消记忆因子,渐消记忆因子其实是遗忘因子的另一种叫法,渐消记忆因子也有很多求解方法,本质上也是对式(4)进行修改至式(9),这里记渐消记忆因子为sss,s≥1s\ge1s≥1。
Pk=AksP^k−1AkT+Qk(9)P_k=A_ks\hat P_{k-1}A_k^T+Q_k\tag{9}Pk​=Ak​sP^k−1​AkT​+Qk​(9)

夏启军学者在90年发表于自动化学报中的论文《渐消卡尔曼滤波的最佳自适应算及其应用》一直延续到现在,最常用的还是他第二类算法,最佳遗忘因子的一步算法,本文将介绍该算法模型。

渐消记忆因子求解
s=max{1,1ntr(NkMk−1)}(10)s=max\{1,\frac{1}{n}tr(N_kM_k^{-1})\}\tag{10}s=max{1,n1​tr(Nk​Mk−1​)}(10)
其中tr()是矩阵求迹的符号,MkM_kMk​和NkN_kNk​表达式为
Mk=HkAkP^k−1AkTHkT(11)M_k=H_kA_k\hat P_{k-1}A_k^TH_k^T\tag{11}Mk​=Hk​Ak​P^k−1​AkT​HkT​(11)
Nk=Pvk−HkQkHkT−Rk(12)N_k=P_{vk}-H_kQ_kH_k^T-R_k\tag{12}Nk​=Pvk​−Hk​Qk​HkT​−Rk​(12)
其中,Pvk=E(VkVkT)P_{vk}=E(V_kV_k^T)Pvk​=E(Vk​VkT​),Vk=Akxk−LkV_k=A_kx_k-L_kVk​=Ak​xk​−Lk​,VkV_kVk​称为预测残差,一般通过开窗估计法确定PvkP_{vk}Pvk​
P~vk=1k∑i=1kViViT(13)\tilde{P}_{vk}=\frac{1}{k}\sum\limits_{i=1}^{k}V_iV_i^T\tag{13}P~vk​=k1​i=1∑k​Vi​ViT​(13)

通过对式(11)进行分析Mk=Pk=E(xkxkT)=E(HkAkx^k−1(HkAkx^k−1)T)M_k=P_k=E(x_kx_k^T)=E(H_kA_k\hat x_{k-1}(H_kA_k\hat x_{k-1})^T)Mk​=Pk​=E(xk​xkT​)=E(Hk​Ak​x^k−1​(Hk​Ak​x^k−1​)T),同理,式(12)也代表先验状态xkx_kxk​的协方差矩阵不过相比于MkM_kMk​,NkN_kNk​中包含了量测更新结果,即NkN_kNk​和MkM_kMk​迹的比值为先验状态协方差矩阵在量测和预测时的比值。

式(9)的简便估计算法
s=max{1,tr(Nk)tr(Mk)}(14)s=max\{1,\frac{tr(N_k)}{tr(M_k)}\}\tag{14}s=max{1,tr(Mk​)tr(Nk​)​}(14)

但是,式(12)中,由于开窗估计法难以解决环境突变问题,即观测突变,带来的随机模型误差,有的学者对此进行了改进
P~vk={sk−1VkVkT1+sk−1k>112V0V0Tk=1(15)\tilde{P}_{vk}=\left\{ \begin{array}{rcl} \frac{s_{k-1}V_kV_k^T}{1+s_{k-1}} & & {k>1} \\ \frac{1}{2}V_0V_0^T & & {k=1} \end{array} \right. \tag{15}P~vk​={1+sk−1​sk−1​Vk​VkT​​21​V0​V0T​​​k>1k=1​(15)
通过对比式(13)和(15)经过修改后的自适应因子对本历元的环境突变更加敏感。

渐消记忆因子也是对随机模型的误差进行补偿,经过修改后,下一历元的先验协方差矩阵大于等于当前时刻传统卡尔曼滤波后验状态协方差矩阵(对比),进而调整预测值和观测值间的权重关系。

注意:如果按照严恭敏老师《捷联惯导算法与组合导航原理》P163中的说法,单重渐消记忆因子卡尔曼滤波又被称为强跟踪卡尔曼滤波。
按照字面意思理解,强跟踪滤波跟踪的是目标的运动状态,假设运动状态匀速开始,突然变为加速,此时先验残差增加,自适应因子增加,导致先验P矩阵增加。(感谢师弟的例子)

4 自适应滤波

自适应滤波的目标是通过自适应因子调节先验P矩阵,平衡历史状态和观测值的权。严格来说,遗忘因子、渐消记忆因子都是自适应因子的一种。具有和式(8)式(9)一样的公式调节形式,这里我们定义自适应因子为α\alphaα
Pk=AkαP^k−1AkT+Qk(16)P_k=A_k\alpha\hat P_{k-1}A_k^T+Q_k\tag{16}Pk​=Ak​αP^k−1​AkT​+Qk​(16)

4.1 误差判别统计量

对比遗忘因子和渐消记忆因子来说,自适应因子具有更直观的理论依据,主要通过构建误差判别统计量估计自适应因子,详细内容可见杨院士论文《自适应抗差滤波理论及应用的主要进展》,误差判别统计量有状态不符值统计量、速度不符值统计量、预测残差统计量和方差分量比统计量。

4.1.1 状态不符值统计量

利用状态参数估计向量x^k\hat x_kx^k​(滤波解)和预测状态向量xkx_kxk​构建统计量
x^k−xk=(Δx^12+Δx^22+…+Δx^k2)12(17)\hat x_k-x_k=(\Delta \hat x_1^2+\Delta \hat x_2^2+\ldots+\Delta \hat x_k^2)^\frac{1}{2}\tag{17}x^k​−xk​=(Δx^12​+Δx^22​+…+Δx^k2​)21​(17)
判别统计量
Δx^k=x^k−xktr(Pk)(18)\Delta \hat x_k=\frac{\hat x_k-x_k}{\sqrt{tr(P_k)}}\tag{18}Δx^k​=tr(Pk​)​x^k​−xk​​(18)
简单分析:(1)计算历元的观测数量要大于待估状态参数的数量;(2)观测量估计的状态参数向量x^k\hat x_kx^k​应尽可能精确,否则统计量Δx^k\Delta \hat x_kΔx^k​不能反映动力学模型的误差;(3)统计量Δx^k\Delta \hat x_kΔx^k​反映模型的整体误差,任何状态分量的扰动都将视为整体模型存在扰动。

4.1.2 速度不符值统计量

根据状态得到相邻历元kkk和k−1k-1k−1时间内速度估计为
x^k˙=x^k−x^ktk−tk−1(19)\dot {\hat x_k}=\frac{\hat x_k-\hat x_k}{t_k-t_{k-1}}\tag{19}x^k​˙​=tk​−tk−1​x^k​−x^k​​(19)
相应的滤波速度与估计速度不符值函数为
Δx^k˙=x^k˙−xk˙tr(Pk)(20)\Delta \dot {\hat x_k}=\frac{\dot{\hat x_k}-\dot {x_k}}{\sqrt{tr(P_k)}}\tag{20}Δx^k​˙​=tr(Pk​)​x^k​˙​−xk​˙​​(20)
此时的PkP_kPk​对应于x^k˙\dot {\hat x_k}x^k​˙​的协方差矩阵。
简单分析:(1)如果Δx^k˙\Delta \dot {\hat x_k}Δx^k​˙​显著异常,则表明预测速度存在异常,或动力学模型存在较大误差;(2)Δx^k˙\Delta \dot {\hat x_k}Δx^k​˙​的计算要求有多余观测信息。

4.1.3 预测残差统计量

ΔVk=(VkTVktr(Pvk))12(21)\Delta V_k=(\frac{V_k^TV_k}{tr(P_{v_k})})^\frac{1}{2}\tag{21}ΔVk​=(tr(Pvk​​)VkT​Vk​​)21​(21)
简单分析:(1)不需要在滤波前计算状态向量参考值;(2)不需要观测量个数一定大于状态参数个数;(3)与统计量Δx^k\Delta \hat x_kΔx^k​相比,可能含有更多的测量误差(不只是观测误差)。

4.1.4 方差分量比统计量

如果将tkt_ktk​时刻的观测值LkL_kLk​和状态先验xkx_kxk​看成两组观测向量,则他们的方差分量应能反映其相应的观测精度和模型精度(量测与预测),于是可用方差分量比构造误差判别统计量。其中,LkL_kLk​和xkx_kxk​的Helmert方差分量估计公式为
σ^vk2=VkTPkVkrk(21)\hat \sigma_{v_k}^2=\frac{V_k^TP_kV_k}{r_k}\tag{21}σ^vk​2​=rk​VkT​Pk​Vk​​(21)
σ^xk2=VxkTPxkVxkrx(22)\hat \sigma_{x_k}^2=\frac{V_{x_k}^TP_{x_k}V_{x_k}}{r_x}\tag{22}σ^xk​2​=rx​Vxk​T​Pxk​​Vxk​​​(22)
式(21)和(22)分别为观测值和先验值得方差分量,rkr_krk​和rxr_xrx​分别为观测值和先验值冗余数目,VkV_kVk​和VxkV_{x_k}Vxk​​分别为k时刻观测值和先验值的残差向量。
Vxk=x^k−xk(23)V_{x_k}=\hat x_k-x_k\tag{23}Vxk​​=x^k​−xk​(23)
由方差分量比构造的模型误差统计量为
Sk=σ^vk2σ^xk2≈VxkTPxkVxkrxσ^vk2(24)S_k=\frac{\hat \sigma_{v_k}^2}{\hat \sigma_{x_k}^2}\approx \frac{V_{x_k}^TP_{x_k}V_{x_k}}{r_x \hat \sigma_{v_k}^2}\tag{24}Sk​=σ^xk​2​σ^vk​2​​≈rx​σ^vk​2​Vxk​T​Pxk​​Vxk​​​(24)
简单分析:(1)SkS_kSk​的计算需要冗余观测,否则统计量不能有效地反映模型误差;(2)VkV_kVk​和VxkV_{x_k}Vxk​​对应相同的状态估计量x^k\hat x_{k}x^k​;(3)如果采用迭代计算SkS_kSk​的计算量稍大于Δx^k\Delta \hat x_kΔx^k​和ΔV^k\Delta \hat V_{k}ΔV^k​。

4.2 自适应因子

自适应因子的构建以其分段数目分为了二段式和三段式,还有指数函数表示的自适应因子和选权法表示的自适应因子,主要使用形式为前两种。接下来,以统计量Δxk\Delta x_kΔxk​为例进行说明。

4.2.1 三段式自适应因子

αk={1Δxk≤c0c0Δxk(c1−∣Δxk∣c1−c0)2k>10Δxk>c1(25){\alpha}_{k}=\left\{ \begin{array}{rcl} 1 & & {\Delta x_k \le c_0} \\ \frac{c_0}{\Delta x_k} (\frac{c_1- \lvert \Delta x_k \rvert}{c_1-c_0})^2 & & {k>1} \\ 0 & & {\Delta x_k > c_1} \end{array} \right. \tag{25}αk​=⎩⎨⎧​1Δxk​c0​​(c1​−c0​c1​−∣Δxk​∣​)20​​Δxk​≤c0​k>1Δxk​>c1​​(25)
其中,c0c_0c0​和c1c_1c1​均为常值,取值范围c0=1.0−1.5c_0=1.0-1.5c0​=1.0−1.5,c1=3.0−8.0c_1=3.0-8.0c1​=3.0−8.0。

4.2.2 二段式自适应因子

αk={1Δxk≤ccΔxkΔxk>c(26){\alpha}_{k}=\left\{ \begin{array}{rcl} 1 & & {\Delta x_k \le c} \\ \frac{c}{\Delta x_k} & & {\Delta x_k > c} \end{array} \right. \tag{26}αk​={1Δxk​c​​​Δxk​≤cΔxk​>c​(26)
式中,c1c_1c1​为常数,取值范围c1=1.0−2.5c_1=1.0-2.5c1​=1.0−2.5。
相比于三段式自适应因子,二段式自适应因子永不为0,即历史状态信息影响最优状态估计结果,并且其减小趋势缓于三段式。

4.2.3 指数函数表示的自适应因子

αk={1Δxk≤ce−(Δxk−c)2Δxk>c(27){\alpha}_{k}=\left\{ \begin{array}{rcl} 1 & & {\Delta x_k \le c} \\ e^{-(\Delta x_k-c)^2} & & {\Delta x_k > c} \end{array} \right. \tag{27}αk​={1e−(Δxk​−c)2​​Δxk​≤cΔxk​>c​(27)
其中,c也为常数,与4.2.2中结构类似。

4.2.4 选权法表示的自适应因子

αk={1Δxk≤c0Δxk>c(26){\alpha}_{k}=\left\{ \begin{array}{rcl} 1 & & {\Delta x_k \le c} \\ 0 & & {\Delta x_k > c} \end{array} \right. \tag{26}αk​={10​​Δxk​≤cΔxk​>c​(26)

5 Sage-Husa自适应滤波

Sage-Husa滤波方法采用开窗法,即滑动窗口,确定当前历元观测向量协方差矩阵RkR_kRk​和模型误差协方差矩阵QkQ_kQk​。相比于第4章中的自适应滤波,Sage滤波不需要已知各种方差等参数,但是需要提前确定窗口大小,窗口大小的选择影响到定位精度。窗口选择太大,遇到突变情况无法反映真实结果,窗口选择太小,又不足以刻画相应误差特征。

在开窗估计法之前先介绍一下残差向量和新息向量,即预测残差向量,分别为
V^k=zk−Hkx^k(27)\hat V_k=z_k-H_k \hat x_k \tag{27}V^k​=zk​−Hk​x^k​(27)
Vk=zk−Hkxk(28)V_k=z_k-H_kx_k \tag{28}Vk​=zk​−Hk​xk​(28)
V^k\hat V_kV^k​经过观测信息修正,包含动力学模型误差和量测误差,VkV_kVk​未经过观测值修正,称为新息,新息向量更能反应动态系统的扰动误差,二者之间的关系为
V^k=(I−HkKk)Vk(29)\hat V_k=(I-H_kK_k) V_k \tag{29}V^k​=(I−Hk​Kk​)Vk​(29)
V^k\hat V_kV^k​和VkV_kVk​的协方差矩阵分别为
P^V^k=Rk−HkP^kHkT(30)\hat P_{\hat V_k}=R_k-H_k \hat P_kH_k^T \tag{30}P^V^k​​=Rk​−Hk​P^k​HkT​(30)
PVk=Rk+HkPkHkT(31)P_{V_k}=R_k+H_kP_kH_k^T \tag{31}PVk​​=Rk​+Hk​Pk​HkT​(31)
一开始,楼主通过式(27)和(28)利用协方差传播律去解释式(30)和(31),但是发现(31)符号有误。其实,二者函数式不一样。在新息向量中,新息由观测值和预测值组成,残差向量中,观测值由后验状态和残差组成,再按照协方差传播律去解释就行了。要搞清楚谁加谁,谁减谁。(不知道理解是否正确,欢迎指教)

5.1 观测噪声协方差矩阵的开窗估计

观测噪声协方差矩阵的开窗估计方法可以采用预测残差向量或观测残差向量进行估计,前者为先验状态估计的预测残差,后者为后验状态的验后残差。

第一种,预测残差向量开窗估计法。
PVk=1N∑j=0NVk−jVk−jT(32)P_{V_k}=\frac{1}{N} \sum_{j=0}^NV_{k-j}V_{k-j}^T \tag{32}PVk​​=N1​j=0∑N​Vk−j​Vk−jT​(32)
则tkt_ktk​时刻观测值协方差矩阵
Rk=PVk−HkPkHkT(33)R_k=P_{V_k}-H_kP_kH_k^T \tag{33}Rk​=PVk​​−Hk​Pk​HkT​(33)

第二种,观测残差向量开窗估计法
PV^k=1N∑j=0NV^k−jV^k−jT(34)P_{\hat V_k}=\frac{1}{N} \sum_{j=0}^N\hat V_{k-j}\hat V_{k-j}^T \tag{34}PV^k​​=N1​j=0∑N​V^k−j​V^k−jT​(34)
则tkt_ktk​时刻观测值协方差矩阵
Rk=PV^k+HkP^kHkT(35)R_k=P_{\hat V_k}+H_k\hat P_kH_k^T \tag{35}Rk​=PV^k​​+Hk​P^k​HkT​(35)
然而,由式(35)估计RkR_kRk​时,需要先得到P^k\hat P_kP^k​,二者相悖,因此可以利用前NNN个历元估计当前时刻的RkR_kRk​,式(34)和(35)转化为(36)和(37)
PV^k=1N∑j=1N+1V^k−jV^k−jT(36)P_{\hat V_k}=\frac{1}{N} \sum_{j=1}^{N+1}\hat V_{k-j}\hat V_{k-j}^T \tag{36}PV^k​​=N1​j=1∑N+1​V^k−j​V^k−jT​(36)
Rk=PV^k−1+Hk−1P^k−1Hk−1T(37)R_k=P_{\hat V_{k-1}}+H_{k-1}\hat P_{k-1}H_{k-1}^T \tag{37}Rk​=PV^k−1​​+Hk−1​P^k−1​Hk−1T​(37)

注意:(1)第一种方法内包含历史状态中的误差,若xkx_kxk​误差越大,则VkV_kVk​误差越大,计算的RkR_kRk​稳定性也就越差;
(2)第一种方法可能出现负定现象;
(3)两种方法都是对前N个历元观测信息进行了平均,要求当前时刻观测环境要与历史的N个观测环境一致,“这种自适应估计,很难真正实现‘自适应’”。
(4)两种方法都要求矩阵同类别、同分布、同维度。

5.2 动态模型噪声矩阵的开窗估计

令状态改正值Vxk=x^k−xkV_{x_k}=\hat x_k-x_kVxk​​=x^k​−xk​,容易得到
Qk=PVxk+P^k−AkP^k−1AkT(38)Q_k=P_{V_{x_k}}+\hat P_k-A_{k}\hat P_{k-1}A_{k}^T \tag{38}Qk​=PVxk​​​+P^k​−Ak​P^k−1​AkT​(38)
VxkV_{x_k}Vxk​​协方差矩阵为(开窗估计)
PVxk=1N∑j=0NVxkVxkT(39)P_{V_{x_k}}=\frac{1}{N} \sum_{j=0}^{N}V_{x_k}V_{x_k}^T \tag{39}PVxk​​​=N1​j=0∑N​Vxk​​Vxk​T​(39)
然而,该方法求VxkV_{x_k}Vxk​​要先求QkQ_kQk​,为了避免这个问题,直接估计QkQ_kQk​。
注意到VxkV_{x_k}Vxk​​和VkV_kVk​,
Vxk=−KkVk(40)V_{x_k}=-K_kV_k\tag{40}Vxk​​=−Kk​Vk​(40)
进一步有
PVxk=KkPVkKkT(41)P_{V{x_k}}=K_kP_{V_k}K_k^T\tag{41}PVxk​​=Kk​PVk​​KkT​(41)
在由5.1节估计出PVkP_{V_k}PVk​​之后,在稳态情况下,可以直接用PVxkP_{V_{x_k}}PVxk​​​近似代替QkQ_kQk​。

注意:利用自适应估计时,状态噪声协方差矩阵和观测噪声协方差矩阵应当一方减小一方增加,若二者同时增加或减小可能会导致滤波发散。

参考文献

1、卡尔曼滤波器的遗忘因子. https://blog.csdn.net/qwe900/article/details/105867521.
2、信息滤波、UD滤波、遗忘滤波和自适应滤波. https://blog.csdn.net/Ruins_LEE/article/details/116769786.
3、夏启军,孙优贤,周春晖.渐消卡尔曼滤波器的最佳自适应算法及其应用[J].自动化学报,1990(03):210-216.
4、杨元喜. 自适应动态导航定位(第二版)。(强烈推荐)
5、严恭敏.捷联惯导算法与组合导航原理。
6、杨元喜,任夏,许艳. 自适应抗差滤波理论及应用的主要进展。

【多源融合】自适应卡尔曼滤波的多种形式:遗忘卡尔曼滤波、渐消记忆卡尔曼滤波和自适应卡尔曼滤波相关推荐

  1. 【多源融合】滤波融合之卡尔曼滤波与粒子滤波

    多源融合之滤波对比 最近在看CSDN滤波方面的知识,但是很多都是激光雷达.视觉.信号处理等方面的大佬们总结的,我也做过卡尔曼滤波和粒子滤波.博主大地测量学与测量工程专业,主要做定位方面的内容,现在从我 ...

  2. 【多源融合】Sage-Husa滤波完整推导

    [多源融合] Sage-Husa自适应滤波完整推导 基础知识 最大似然估计与自适应滤波 基于新息的观测噪声协方差矩阵(IAE) 基于残差的观测噪声协方差矩阵(RAE) 系统状态噪声协方差矩阵 附录A ...

  3. HAST多源融合精准定位,究竟有何神奇之处?

    核心技术&创新算法 HAST多源融合精准定位 定位技术多源融合 HAST是一种多源融合精准定位技术,持续研究研发融合UWB.蓝牙.北斗.GPS.LBS.WiFi.Sensor.RFID.红外. ...

  4. 多源信息融合_华测导航王超:基于RTK的GNSS与多源融合定位技术和挑战

    全球卫星导航系统(GNSS)作为最具竞争力的定位与导航技术,全天时.全天候为全球用户提供高效可靠的定位导航服务.随着当前对高精度定位服务的要求越来越高,定位环境更加样化且复杂,多源融合定位技术作为全球 ...

  5. 新息自适应卡尔曼滤波matlab代码,基于新息协方差的自适应渐消卡尔曼滤波器

    第33卷第12期 系统工程与电子技术 V01.33 No.12 2011年12月 Systems Engineering and Electronics 'December 2011 文章编号:i00 ...

  6. 基于自适应无迹卡尔曼滤波算法(AUKF)锂电池SOC估计,噪声系数自适应 Matlab程序

    基于自适应无迹卡尔曼滤波算法(AUKF)锂电池SOC估计,噪声系数自适应 Matlab程序 仿真模型建模数据mat Sci一篇参考文献 ID:77100657373800632张徳帅123

  7. 新息自适应卡尔曼滤波matlab代码,基于新息协方差的自适应渐消卡尔曼滤波器.pdf...

    第33卷第12期 系统工程与电子技术 V01.33No.12 andElectronics 'December2011 2011年12月 SystemsEngineering 文章编号:i001-50 ...

  8. unity android屏幕自适应,Android应用开发之unity打开移动摄像头,并自适应屏幕显示摄像头数据。兼容android和ios...

    本文将带你了解Android应用开发之unity打开移动摄像头,并自适应屏幕显示摄像头数据.兼容android和ios,希望本文对大家学Android有所帮助. 跨平台并自适应显示摄像头数据新建工程并 ...

  9. 深度学习原理与框架-RNN网络框架-LSTM框架 1.控制门单元 2.遗忘门单元 3.记忆门单元 4.控制门单元更新 5.输出门单元 6.LSTM网络结构...

    LSTM网络是有LSTM每个单元所串接而成的, 从下面可以看出RNN与LSTM网络的差异, LSTM主要有控制门单元和输出门单元组成 控制门单元又是由遗忘门单元和记忆门单元的加和组成. 1.控制门单元 ...

最新文章

  1. NumPy — 创建全零、全1、空、arange 数组,array 对象类型,astype 转换数据类型,数组和标量以及数组之间的运算,NumPy 数组共享内存
  2. C 语言编程 — 编程规范
  3. JavaScript 学习(2) - JS的内建对象
  4. Delphi 的运算符重载(1)
  5. php tostring(),【php】“__toString()”方法使用,php__tostring
  6. C#开发笔记之10-如何用C#根据发票代码判断发票种类?
  7. linux驱动编写(其他的驱动代码)
  8. 安装Python package
  9. python leetcode_八十二、Python | Leetcode贪心算法系列
  10. Win10电脑如何设置环境变量
  11. pythonlauncher是干什么用的_python的launcher用法知识点总结
  12. 滴滴宣布架构大调整,强调安全第一
  13. mysql+语句+when_MySQL的CASEWHEN语句
  14. [CTF]学习资源推荐
  15. ai的预览模式切换_ai模式切换快捷键是什么啊?ai模式切换方法
  16. 董明珠为什么选择长沙?
  17. python3.6library 学习 1.introduction,2.built-infunction
  18. 【Three.js】简单地3D工具-Three.js建模入门基础教程
  19. 怎样把多个pdf合并为一份?多个pdf怎么合并成一个pdf?
  20. 51单片机八位数码管1到F动态滚动显示仿真及程序

热门文章

  1. 关于Xcode修改APP名称
  2. 手机构建Linux环境,Linux手机DIY.构建统一安装包
  3. CSDN怎么加粗字体
  4. Re: 客户协作 OVER 合同谈判
  5. MT【108】线面角最小
  6. linux下redis设置密码登录(简单易懂)
  7. 别被别人抢走了你的时间!
  8. OFD文件怎么转PDF?ofd文件转换为pdf格式教程
  9. python安装第三方库的方法
  10. 如何用手机来拍证件照