一、姿态误差分析

1.写出不考虑误差时的微分方程

以“东-北-天(E-N-U)”坐标系为导航坐标系(n系)“右-前-上”坐标系为(b系)时,姿态微分方程可以表示为
C ˙ b n = C b n ( ω n b b × ) \dot{C}_b^n =C_b^n (\omega ^b_{nb}\times) C˙bn=Cbn(ωnbb×)
当考虑地球自转角速度时, ω n b b \omega ^b_{nb} ωnbb 不易直接测量,因此上面的微分方程可以拆解为:

其中 ω i n n \omega ^n_{in} ωinn 表示导航系(n系)相对于惯性系(i系)的旋转,它包含地球自转和导航系相对于地球的旋转,其表达式为:
ω i n n = ω i e n + ω e n n \omega ^n_{in}=\omega ^n_{ie}+\omega ^n_{en} ωinn=ωien+ωenn

2.写出考虑误差时的微分方程

C ~ b n ˙ = C ~ b n ( ω i b n × ) − ( ω i n n × ) C ~ b n \dot{\tilde{C}_b^n}=\tilde{C}_b^n(\omega ^n_{ib}\times)-(\omega ^n_{in}\times)\tilde{C}_b^n C~bn˙=C~bn(ωibn×)(ωinn×)C~bn

3.写出真实值与理想值之间的关系

(1)姿态误差的引入

理想情况下,从载体坐标系(b 系)到导航坐标系(n 系)的捷联惯导姿态矩阵为 C b n C_b^n Cbn ,而姿态计算时会有误差,一般假设误差在n 系上。有误差的导航坐标系称为计算导航坐标系,简记为 n ′ {n}' n系。此时有误差的姿态矩阵表示为: C b n ~ = C b n ′ = C n n ′ C b n \tilde{C^n_b}=C_b^{{n}'}=C_n^{{n}'}C_b^n Cbn~=Cbn=CnnCbn
以n系作为参考坐标系,记从 n 系至 n ′ n' n系的等效旋转矢量为 (其3个元素也被称作失准角),当它为小量时,根据等效旋转矢量与方向余弦阵关系式:
C n n ′ ≈ I − ( ϕ × ) C_n^{n'} \approx I-(\phi \times ) CnnI(ϕ×)
此时有误差的姿态矩阵表示为:
C b n ~ = [ I − ( ϕ × ) ] C b n \tilde{C_b^n}=[I-(\phi \times )]C_b^n Cbn~=[I(ϕ×)]Cbn

(2)imu角速度误差的引入

含误差的imu角速度可以表示为:
ω i b b ~ = ω i b b + δ ω i b b \tilde{\omega ^b_{ib}}=\omega ^b_{ib}+\delta \omega ^b_{ib} ωibb~=ωibb+δωibb
严格来讲, δ ω i b b \delta \omega ^b_{ib} δωibb包含了imu内参相关的所有误差,而在实际中,会根据任务需求进行化简,只取一部分变量。
在这里插入图片描述

(3)关联误差的引入

在这里插入图片描述
其中:
在这里插入图片描述
在实际使用时,这两项角速度误差均忽略不计,理由如下:
a.在中等精度及以下的惯性导航中,这两项角速度误差相比于器件误差,量级太小,没有考虑的必要。
b.在组合导航中,速度误差和位置误差一直被修正,会使他们的量级进一步减小。

4.把真实值与理想值之间的关系,带入误差时的微分方程

带误差的微分方程为:
在这里插入图片描述
带误差的变量为:
在这里插入图片描述

把这三个带误差的量带入微分方程可得:
在这里插入图片描述

5.把第一步中不考虑误差时的微分方程带入第四步方程

在这里插入图片描述

6.简化方程

上式两边同时右乘 C n b C_n^b Cnb,可得:

在这里插入图片描述
上式可以写为:
在这里插入图片描述
展开并忽略其中的二阶小项,可得:
在这里插入图片描述
又有定理:
在这里插入图片描述
所以姿态误差方程可以重新写为:
在这里插入图片描述
因此有姿态误差方程为:
在这里插入图片描述

二、速度误差分析

在这里插入图片描述

三、位置误差分析

在这里插入图片描述

Logo

开放原子开发者工作坊旨在鼓励更多人参与开源活动,与志同道合的开发者们相互交流开发经验、分享开发心得、获取前沿技术趋势。工作坊有多种形式的开发者活动,如meetup、训练营等,主打技术交流,干货满满,真诚地邀请各位开发者共同参与!

更多推荐