对IKFOM论文中一些关键内容的理解
符号定义
x τ x_{\tau} xτ是 τ \tau τ时刻的状态真值
误差状态变量的线性化部分
IKFOM论文中公式(22)(23)是为了得到公式(24)的结果
而公式(24)是表示基于k时刻前的观测对
τ
\tau
τ时刻误差状态变量
δ
x
τ
∣
k
\delta x_{\tau|k}
δxτ∣k的估计值
δ
x
(
τ
∣
k
)
∣
k
\delta x_{(\tau|k)|k}
δx(τ∣k)∣k等于0,因此对误差状态预测方程在
δ
x
(
τ
∣
k
)
∣
k
\delta x_{(\tau|k)|k}
δx(τ∣k)∣k处线性化结果为:
δ
x
τ
+
1
∣
k
=
δ
x
(
τ
+
1
∣
k
)
∣
k
+
F
x
τ
(
δ
x
τ
∣
k
−
δ
x
(
τ
∣
k
)
∣
k
)
+
F
w
τ
w
τ
\delta x_{\tau+1|k}=\delta x_{(\tau+1|k)|k}+F_{x_\tau} (\delta x_{\tau|k}-\delta x_{(\tau|k)|k})+F_{w_{\tau}}w_{\tau}
δxτ+1∣k=δx(τ+1∣k)∣k+Fxτ(δxτ∣k−δx(τ∣k)∣k)+Fwτwτ
基于前面的推导
δ
x
(
τ
∣
k
)
∣
k
=
0
;
δ
x
(
τ
+
1
∣
k
)
∣
k
=
0
\delta x_{(\tau|k)|k}=0;\delta x_{(\tau+1|k)|k}=0
δx(τ∣k)∣k=0;δx(τ+1∣k)∣k=0,因此:
δ
x
τ
+
1
∣
k
=
F
x
τ
δ
x
τ
∣
k
+
F
w
τ
w
τ
\delta x_{\tau+1|k}=F_{x_\tau} \delta x_{\tau|k}+F_{w_{\tau}}w_{\tau}
δxτ+1∣k=Fxτδxτ∣k+Fwτwτ
关键就是 δ x τ ∣ k \delta x_{\tau|k} δxτ∣k表示的是 τ \tau τ时刻的误差状态变量,而 δ x ( τ ∣ k ) ∣ k \delta x_{(\tau|k)|k} δx(τ∣k)∣k表示的是 τ \tau τ时刻的误差状态变量的估计值。