网站名称是什么百家号权重查询
符号定义
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 τ时刻的误差状态变量的估计值。