捷联惯导系统学习2.4(4元数微分方程)

⨂ \bigotimes 张量积
已知:
r i = [ r x i r y i r z i ] r^i=\left[ \begin{matrix} r^i_x& r^i_y&r^i_z \\ \end{matrix} \right] ri=[rxiryirzi](三维矢量 r r r i i i坐标系的投影)
r b = [ r x b r y b r z b ] r^b=\left[ \begin{matrix} r^b_x& r^b_y&r^b_z \\ \end{matrix} \right] rb=[rxbrybrzb](三维矢量 r r r i i i坐标系的投影)
Q b i = c o s θ 2 + u ∗ s i n θ 2 Q^i_b=cos\frac{θ}{2}+u*sin\frac{θ}{2} Qbi=cos2θ+usin2θ为4元组3角函数表达式 (i->b)
r i = Q b i ⨂ r b r^i=Q^i_b\bigotimes r^b ri=Qbirb
推导: r B = [ 0 r b ] r^B=\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right] rB=[0rb]
Q b i 。 r b 。 Q i b = M Q b i ( r b 。 Q i b ) = M Q b i M Q i b [ 0 r b ] = [ 1 0 1 × 3 0 3 × 1 C b i ] [ 0 r b ] = [ 0 C i b r b ] = [ 0 r i ] Q^i_b。r^b。Q^b_i=M_{Q^i_b}(r^b。Q^b_i)=M_{Q^i_b}M_{Q^b_i}\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right]=\left[ \begin{matrix} 1 & 0_{1\times3} \\ 0_{3\times1} & C^i_b\\ \end{matrix} \right]\left[ \begin{matrix} 0 \\ r^b\\ \end{matrix} \right]=\left[ \begin{matrix} 0 \\ C_i^br^b\\ \end{matrix} \right]=\left[ \begin{matrix} 0 \\ r^i\\ \end{matrix} \right] QbirbQib=MQbi(rbQib)=MQbiMQib[0rb]=[103×101×3Cbi][0rb]=[0Cibrb]=[0ri]
即:
r i 为 Q B i 。 r b 。 Q i b 的 虚 部 ( 。 为 4 元 数 乘 法 ) r^i为Q^i_B。r^b。Q^b_i的虚部(。为4元数乘法) riQBirbQib4
w i b b w^b_{ib} wibb为b系绕i系的角速度; r ˙ i = 0 ( r i 为 固 定 矢 量 ) \dot r^i=0(r^i为固定矢量) r˙i=0(ri)
则Q的导数为:证明略
Q ˙ b i = 1 2 Q b i w i b b = 1 2 w i b i Q b i \dot Q^i_b=\frac{1}{2}Q^i_bw^b_{ib}=\frac{1}{2}w^i_{ib}Q^i_b Q˙bi=21Qbiwibb=21wibiQbi
Q b i = [ c o s θ 2 u ∗ s i n θ 2 ] Q^i_b=\left[ \begin{matrix} cos\frac{θ}{2}\\ u*sin\frac{θ}{2}\\ \end{matrix} \right] Qbi=[cos2θusin2θ]

Q ˙ b i = [ − θ 2 ˙ s i n θ 2 u ˙ s i n θ 2 + u θ ˙ 2 c o s θ 2 ] \dot Q^i_b=\left[ \begin{matrix} -\dot \frac{θ}{2}sin\frac{θ}{2}\\ \dot usin\frac{θ}{2}+u \frac{\dot θ}{2}cos\frac{θ}{2}\\ \end{matrix} \right] Q˙bi=[2θ˙sin2θu˙sin2θ+u2θ˙cos2θ]
w i b b = u θ ˙ + u ˙ s i n θ − u × u ˙ ( 1 − c o s θ ) w^b_{ib}=u\dot θ+\dot usinθ-u\times \dot u(1-cosθ) wibb=uθ˙+u˙sinθu×u˙(1cosθ)

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值