The Detail of The Error State in

作者: 轻骑兵1390 | 来源:发表于2020-07-16 13:43 被阅读0次

The Detail of The Error State in
minikube
Flutter之State management approac
The error state in MSCKF
apollo client学习笔记
Typescript 引入模块名称与实际名称不符
Missing key(s) in state_dict: "m
angular2项目npm start出现错误
Detail
detail

1. Rotation

The error-state rotation propagation is marked as (14) in msckf2.0,
$^{I} \tilde{\boldsymbol{\theta}}_{\ell+1 \mid \ell} \simeq \hat{\mathbf{R}}_{\ell+1 \mid \ell} \hat{\mathbf{R}}_{\ell \mid \ell}^{T} \cdot^{I} \tilde{\boldsymbol{\theta}}_{\ell \mid \ell}+\tilde{\boldsymbol{\theta}}_{\Delta \ell} \tag{1}$
We give the detail of (1) in this section and firstly simplify the sample from $^{I_{l+1}}_{G}{R} = \space^{I_{l+1}}_{I_l}{R} \cdot \space^{I_{l}}_{G}{R}$ to:
$R_{l+1} = R_{\Delta}R_xl$
Considering ${R} \approx(I_3-[\phi_\times]) \cdot \hat{R}$ , we give the following derivation as:
$\begin{aligned} (I-[\phi_{l+1}]_\times)R_{l+1} &= (I-[\phi_{\Delta}]_\times)R_\Delta \cdot (I-[\phi_l]_\times)R_l \\ R_{l+1}-[\phi_{l+1}]_\times R_{l+1} &= (R_\Delta-[\phi_{\Delta}]_\times R_\Delta) \cdot (R_l-[\phi_l]_\times R_l) \\ &= R_\Delta R_l-[\phi_{\Delta}]_\times R_\Delta R_l -R_\Delta[\phi_l]_\times R_l + \boxed{[\phi_{\Delta}]_\times R_\Delta [\phi_l]_\times R_l}\\ &\approx R_\Delta R_l-[\phi_{\Delta}]_\times R_\Delta R_l -R_\Delta[\phi_l]_\times R_l \\ &= R_{l+1}-[\phi_{\Delta}]_\times R_\Delta R_l -R_\Delta[\phi_l]_\times R_l \end{aligned}$

$\begin{aligned} [\phi_{l+1}]_\times R_{l+1} &= [\phi_{\Delta}]_\times R_\Delta R_l +R_\Delta[\phi_l]_\times R_l \\ [\phi_{l+1}]_\times &= [\phi_{\Delta}]_\times +R_\Delta[\phi_l]_\times R_\Delta^T\\ &= [\phi_{\Delta}]_\times + [R_\Delta\cdot \phi_l]_\times\\ \end{aligned}$
The result is
$\phi_{l+1} = \phi_{\Delta} + R_\Delta\cdot \phi_l$

2. Velocity

We simplify the velocity function to
$v_{l+1} = v_{l} + g\Delta t + R^T_{l}\cdot s_l$

We use $x = \hat{x} + \tilde{x}$ , where $\hat{x}$ is the estimated value and usually calculated by the measurement value. $\tilde{x}$ is the error state.

$\begin{aligned} \hat{v}_{l+1} + \tilde{v}_{l+1} &= (\hat{v}_{l} + \tilde{v}_{l}) + g\Delta t + ((I-[\tilde{\theta}_l]_\times)\hat{R}_{l})^T\cdot (\hat{s}_l + \tilde{s}_l) \\ \hat{v}_{l+1} + \tilde{v}_{l+1} &= (\hat{v}_{l} + \tilde{v}_{l}) + g\Delta t + ((I-[\tilde{\theta}_l]_\times)\hat{R}_{l})^T\cdot (\hat{s}_l + \tilde{s}_l) \\ &= (\hat{v}_{l} + \tilde{v}_{l}) + g\Delta t + (\hat{R}_{l}^T - \hat{R}_{l}^T([\tilde\theta_l]_\times)^T) \cdot (\hat{s}_l + \tilde{s}_l) \\ &= (\hat{v}_{l} + \tilde{v}_{l}) + g\Delta t + (\hat{R}_{l}^T \hat{s}_l + \hat{R}_{l}^T\tilde{s}_l - \hat{R}_{l}^T([\tilde\theta_l]_\times)^T \hat{s}_l - \hat{R}_{l}^T([\tilde\theta_l]_\times)^T \tilde{s}_l) \\ \end{aligned}$
The element $\hat{R}_{l}^T([\tilde\theta_l]_\times)^T \tilde{s}_l$ has two differential value thus is deleted. Then
$\begin{aligned} \cancel{\hat{v}_{l+1}} + \tilde{v}_{l+1} &= \cancel{\hat{v}_{l}} + \tilde{v}_{l} +\cancel{g\Delta t} + \cancel{\hat{R}_{l}^T \hat{s}_l} + \hat{R}_{l}^T\tilde{s}_l - \hat{R}_{l}^T([\tilde\theta_l]_\times)^T \hat{s}_l\\ \tilde{v}_{l+1} &= \tilde{v}_{l} + \hat{R}_{l}^T\tilde{s}_l - \hat{R}_{l}^T([\tilde\theta_l]_\times)^T \hat{s}_l\\ \end{aligned}$
Based on $(u_\times)^T = -u_\times$ and $u_\times v = -v_\times u$ , we finally get
$\tilde{v}_{l+1} = \tilde{v}_{l} + \hat{R}_{l}^T\tilde{s}_l - \hat{R}_{l}^T[\hat{s}_l]_\times \tilde{\theta}_l$

10. Question

10.1 $(I_3 - [\phi_\times])$ ? $(I_3 + [\phi_\times])$ ?

The main different between Hamilton and JPL quaternions is

Hamilton, $ijk = -1$ , right-hand.
JPL, $ijk = 1$ , left-hand.

The difference between $(I_3 - [\phi_\times])$ and $(I_3 + [\phi_\times])$ is also related to Hamilton and JPL quaternions.

The Detail of The Error State in
1. Rotation The error-state rotation propagation is marke...
minikube
Error starting host: Error getting state for host: machin...
Flutter之State management approac
State management approaches Detail Reference[https://flut...
The error state in MSCKF
1. IMU state vector All elements are column vectors. We i...
apollo client学习笔记
查询用法：无需定义state, const { loading, error, data } = useQuer...
Typescript 引入模块名称与实际名称不符
error TS1149: File name '/Users/xxxxxx/state.ts' differs ...
Missing key(s) in state_dict: "m
pytorch加载模型时报错 RuntimeError: Error(s) in loading state_di...
angular2项目npm start出现错误
angular2项目npm start 出现错误 ERROR in ./src/app/global.state....
Detail
NBA传奇巨星科比在3月NBA进入季后赛后开了一档新节目，叫《Detail》。在节目中科比挑选一个球员，把他放在聚...
detail

The Detail of The Error State in

1. Rotation

2. Velocity

10. Question

10.1 $(I_3 - [\phi_\times])$ ? $(I_3 + [\phi_\times])$ ?

相关文章