028捷联惯导更新算法备忘

本文详细解析了惯性导航系统中的姿态更新和速度更新原理,包括四元数转换、等效旋转矢量求解、速度增量计算以及位置更新过程。重点介绍了Bortz方程在旋转矢量微分方程求解中的应用,以及如何通过优化方法减少圆锥运动的不可交换误差。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

1、姿态更新

  对于nnnbbb系,假定有如下四元数转换关系:

  那么:
rn(k+1)=Cb(k+1)n(k+1)rb(k+1)=Cn(k)n(k+1)Cn(k)b(k)Cb(k)n(k)Cb(k+1)b(k)rb(k+1) r^{n(k+1)} = C_{b(k+1)}^{n(k+1)} r^{b(k+1)} = C_{n(k)}^{n(k+1)} C_{n(k)}^{b(k)} C_{b(k)}^{n(k)} C_{b(k+1)}^{b(k)} r^{b(k+1)} rn(k+1)=Cb(k+1)n(k+1)rb(k+1)=Cn(k)n(k+1)Cn(k)b(k)Cb(k)n(k)Cb(k+1)b(k)rb(k+1)

  等价于:
rn(k+1)=Q(tk+1)⊗rb(k+1)⊗Q∗(tk+1)=p∗(h)⊗{Q(tk)⊗[q(h)⊗rb(k+1)⊗q∗(h)]⊗Q∗(tk)}⊗p(h)=[p∗(h)⊗Q(tk)⊗q(h)]⊗rb(k+1)⊗[q∗(h)⊗Q∗(tk)⊗p(h)] \begin{aligned} r^{n(k+1)} &= Q(t_{k+1}) \otimes r^{b(k+1)} \otimes Q^*(t_{k+1})\\ \\ &= p^*(h) \otimes \{ Q(t_k) \otimes [ q(h) \otimes r^{b(k+1)} \otimes q^*(h)] \otimes Q^*(t_k) \} \otimes p(h) \\ \\ &= [p^*(h) \otimes Q(t_k) \otimes q(h)] \otimes r^{b(k+1)} \otimes [q^*(h) \otimes Q^*(t_k) \otimes p(h)] \end{aligned} rn(k+1)=Q(tk+1)rb(k+1)Q(tk+1)=p(h){Q(tk)[q(h)rb(k+1)q(h)]Q(tk)}p(h)=[p(h)Q(tk)q(h)]rb(k+1)[q(h)Q(tk)p(h)]

  所以:
Q(tk+1)=p∗(h)⊗Q(tk)⊗q(h) Q(t_{k+1}) = p^*(h) \otimes Q(t_k) \otimes q(h) Q(tk+1)=p(h)Q(tk)q(h)

  其中:p∗(h)p^*(h)p(h)−ωinn-\omega_{in}^{n}ωinn确定,q(h)q(h)q(h)圆锥误差补偿后的等效旋转矢量确定。

等效旋转矢量的求解,就是求解旋转矢量微分方程(Bortz方程),该方程通过n子样算法求解。为了使旋转矢量准确,还要在子样算法求解旋转矢量中对其进行圆锥运动的不可交换误差补偿。

2、速度更新

  速度更新需要计算三部分的内容,即前一时刻速度、比力引起的速度补偿、有害加速度引起的速度补偿。计算的重点是比力引起的速度补偿。该部分包含加计输出的速度增量、速度的旋转效应补偿以及速度的划桨效应补偿。另外速度的划桨效应补偿还应对其进行优化,方法及系数同等效旋转矢量的不可交换误差补偿优化。最后还要把比力引起的速度补偿从b系转换到n系进行速度的更新。

秦书中的姿态和速度更新没有将Cn(k)n(k+1)C_{n(k)}^{n(k+1)}Cn(k)n(k+1)计算在内,而是事后进行了补偿,严讲义中将Cn(k)n(k+1)C_{n(k)}^{n(k+1)}Cn(k)n(k+1)直接计算在内。

3、位置更新

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值