【技术实现步骤摘要】
一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法
[0001]本专利技术属于惯性导航
,涉及一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法。
技术介绍
[0002]惯性导航系统是一种完全自主式的定位定向设备,可不依赖外界任何有源信息即可确定载体的姿态、速度和位置信息,广泛应用于导航定位、工程测量等众多领域。其主要是利用惯性测量元件陀螺仪和加速度计自主测量载体相对惯性空间的角速度和加速度信息,并在导航坐标系下进行积分解算得出载体的姿态、速度和位置信息。初始对准是惯性导航系统进行导航定位的关键一步,其主要是确定初始时刻载体的姿态矩阵,初始对准的精度将直接影响导航定位的精度。在惯性导航系统中,为了方便导航计算,通常将人为定义在参考椭球体法线的正常重力矢量代替大地水准面垂线的真实重力矢量进行计算,真实重力矢量与正常重力矢量之差称为重力扰动矢量,方向上的差异称之为垂线偏差,垂线偏差会直接影响初始对准性能。对高精度惯性导航系统而言,这种误差往往是不可忽视的,需要加以补偿。
[0003]在本专利技术以前的现有技术中,垂线偏差补偿方法主要分为实测垂线偏差补偿和基于重力场模型补偿两种方式。利用重力梯度仪和矢量重力仪实测的方式受成本高、技术不够完善等诸多条件限制,无法从根本上解决垂线偏差测量精度的问题,致使补偿效果有限,无法应用于工程实践。北京航空航天大学房建成等发表论文“An Accurate Gravity Compensation Method for High
‑
Accuracy Airbo
【技术保护点】
【技术特征摘要】 【专利技术属性】
1.一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法,所述的重力场球谐模型补偿垂线偏差的惯导自对准方法是指凝固坐标系的垂线偏差补偿粗对准和补偿卡尔曼滤波精对准相结合的方法,其特征在于:利用高精度重力场球谐模型直接计算对准点的重力扰动值在n系下的分量,并利用四元数法将其投影至导航坐标系n
′
系下进行补偿,最终求得载体天文方位角,提高对准性能,具体包括以下步骤:步骤1:在惯导自对准开始前,利用转台对惯性导航系统进行标定,精确地估计出陀螺常值漂移和加速度计常值零偏,并在输出数据中扣除相应常值误差;步骤2:定义导航坐标系n系和n
′
系,n系表示以参考椭球面法线为天向建立的东北天坐标系,n
′
系表示以真垂线方向(真实重力方向)为天向建立的东北天导航坐标系,静基座初始对准时,载体位置坐标精确已知,地理纬度L,经度λ,高程h,通过正常重力模型计算初始对准点的正常重力矢量γ
n
;γ
n
=[0 0
ꢀ‑
γ]
T
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)步骤3:构建高精度重力场球谐模型,输入惯性导航系统初始对准点纬度L、经度λ和高程h,计算重力扰动在n系下的分量δg
n
,补偿重力扰动后,可得真实重力矢量在n系下的投影为g
n
;g
n
=γ
n
+δg
ꢀꢀꢀꢀꢀꢀꢀꢀ
(2)步骤4:将步骤3计算得出的补偿重力扰动后的矢量g
n
绕旋转轴u转动角度θ后,得到导航坐标系n
′
系下的真实重力扰动矢量g
n
′
=[0 0
ꢀ‑
g]
T
;步骤5:计算出的姿态转换矩阵求得垂线偏差补偿后的真实重力矢量g
n
′
步骤6:将补偿后的真实重力矢量g
n
′
用于基于凝固坐标系的粗对准方法中,得到载体姿态矩阵粗略估值该解算过程均在导航坐标系n
′
系下进行,b表示载体坐标系;步骤7:将补偿后的真实重力矢量g
n
′
技术研发人员:张志利,周召发,郝诗文,冯磊,赵军阳,
申请(专利权)人:中国人民解放军火箭军工程大学,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。