q = q 0 + q 1 i + q 2 j + q 3 k {q}=q_{0}+q_{1} i+q_{2} j+q_{3} k q=q0+q1i+q2j+q3k
q ˙ = q ˙ 0 + q ˙ 1 i + q ˙ 2 j + q ˙ 3 k \dot{q}=\dot{q}_{0}+\dot{q}_{1} i+\dot{q}_{2} j+\dot{q}_{3} k q˙=q˙0+q˙1i+q˙2j+q˙3k
lim t → 0 q ( t + δ t ) − q ( t ) δ t \quad\lim _{t \rightarrow 0} \frac{\mathrm{q}(t+\delta t)-\mathrm{q}(t)}{\delta t} limt→0δtq(t+δt)−q(t)
= lim t → 0 δ q ⊗ q ( t ) − q ( t ) δ t =\lim _{t \rightarrow 0} \frac{\delta \mathbf{q} \otimes \mathbf{q}(t)-\mathbf{q}(t)}{\delta t} =limt→0δtδq⊗q(t)−q(t)
= lim t → 0 ( δ q − 1 ) ⊗ q ( t ) δ t =\lim _{t \rightarrow 0} \frac{(\delta \mathbf{q}-1) \otimes \mathbf{q}(t)}{\delta t} =limt→0δt(δq−1)⊗q(t)
= lim t → 0 [ 0 δ θ 2 ] ⊗ q ( t ) δ t =\lim _{t \rightarrow 0}\frac{\left[\begin{array}{l}0 \\ \frac{\delta \theta}{2}\end{array}\right] \otimes \mathbf{q}(t)}{\delta t} =limt→0δt[02δθ]⊗q(t)
ω = lim t → 0 δ θ δ t \omega=\lim _{t \rightarrow 0} \frac{\delta \theta}{\delta t} ω=limt→0δtδθ
ω = [ 0 ω x ω y ω z ] ⊤ \omega=\begin{bmatrix} 0 & \omega_{x} & \omega_{y} & \omega_{z}\end{bmatrix}^\top ω=[0ωxωyωz]⊤
q ˙ = 1 2 [ 0 ω ] ⊗ q = 1 2 Ω ( ω ) q \dot{q}=\frac{1}{2}\left[\begin{array}{c}0 \\ \omega\end{array}\right] \otimes \mathbf{q}=\frac{1}{2} \Omega(\omega) q q˙=21[0ω]⊗q=21Ω(ω)q
⌊ ω ] × = [ 0 − ω z ω y ω z 0 − ω x − ω y ω x 0 ] \lfloor\omega]_{\times}=\left[\begin{array}{ccc}0 & -\omega_{z} & \omega_{y} \\ \omega_{z} & 0 & -\omega_{x} \\ -\omega_{y} & \omega_{x} & 0\end{array}\right] ⌊ω]×=⎣⎡0ωz−ωy−ωz0ωxωy−ωx0⎦⎤
Ω ( ω ) = [ − ⌊ ω ⌋ × ω − ω T 0 ] = [ 0 ω z − ω y ω x − ω z 0 ω x ω y ω y − ω x 0 ω z − ω x − ω y − ω z 0 ] \Omega(\omega)=\left[\begin{array}{cc}-\lfloor\omega\rfloor_{\times} & \omega \\ -\omega^{T} & 0\end{array}\right]=\left[\begin{array}{cccc}0 & \omega_{z} & -\omega_{y} & \omega_{x} \\ -\omega_{z} & 0 & \omega_{x} & \omega_{y} \\ \omega_{y} & -\omega_{x} & 0 & \omega_{z} \\ -\omega_{x} & -\omega_{y} & -\omega_{z} & 0\end{array}\right] Ω(ω)=[−⌊ω⌋×−ωTω0]=⎣⎢⎢⎡0−ωzωy−ωxωz0−ωx−ωy−ωyωx0−ωzωxωyωz0⎦⎥⎥⎤
Sola, J., 2017. Quaternion kinematics for the error-state Kalman filter. arXiv preprint arXiv:1711.02508.