CN112798014A - 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 - Google Patents
一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 Download PDFInfo
- Publication number
- CN112798014A CN112798014A CN202011110959.2A CN202011110959A CN112798014A CN 112798014 A CN112798014 A CN 112798014A CN 202011110959 A CN202011110959 A CN 202011110959A CN 112798014 A CN112798014 A CN 112798014A
- Authority
- CN
- China
- Prior art keywords
- gravity
- coordinate system
- carrier
- alignment
- vector
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法,其特征在于:利用高精度重力场球谐模型直接计算对准点的重力扰动值的分量,并利用四元数法将其投影至导航坐标系系下进行补偿,具体包括:开始前标定,估计出陀螺常值漂移和加速度计常值零偏;通过正常重力模型计算初始对准点的正常重力矢量;补偿重力扰动后得真实重力矢量在n系下的投影;绕旋转轴u转动角度θ后,得到导航坐标系n′系下的真实重力扰动矢量;求垂线偏差补偿后的真实重力矢量;得到载体姿态矩阵粗略估值;补偿后的真实重力矢量用于基于卡尔曼滤波的精对准,最终求得载体天文方位角,提高了对准性能。
Description
技术领域
本发明属于惯性导航技术领域,涉及一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法。
背景技术
惯性导航系统是一种完全自主式的定位定向设备,可不依赖外界任何有源信息即可确定载体的姿态、速度和位置信息,广泛应用于导航定位、工程测量等众多领域。其主要是利用惯性测量元件陀螺仪和加速度计自主测量载体相对惯性空间的角速度和加速度信息,并在导航坐标系下进行积分解算得出载体的姿态、速度和位置信息。初始对准是惯性导航系统进行导航定位的关键一步,其主要是确定初始时刻载体的姿态矩阵,初始对准的精度将直接影响导航定位的精度。在惯性导航系统中,为了方便导航计算,通常将人为定义在参考椭球体法线的正常重力矢量代替大地水准面垂线的真实重力矢量进行计算,真实重力矢量与正常重力矢量之差称为重力扰动矢量,方向上的差异称之为垂线偏差,垂线偏差会直接影响初始对准性能。对高精度惯性导航系统而言,这种误差往往是不可忽视的,需要加以补偿。
在本发明以前的现有技术中,垂线偏差补偿方法主要分为实测垂线偏差补偿和基于重力场模型补偿两种方式。利用重力梯度仪和矢量重力仪实测的方式受成本高、技术不够完善等诸多条件限制,无法从根本上解决垂线偏差测量精度的问题,致使补偿效果有限,无法应用于工程实践。北京航空航天大学房建成等发表论文“An Accurate GravityCompensation Method for High-Accuracy Airborne POS”,提出了一种直接做差-建模的方法,该方法在一定程度上提升了系统精度,但还是无法从根本上解决垂线偏差测量精度问题,影响补偿效果。目前全球已有多个高精度重力场球谐模型公布,国内外学者也纷纷利用球谐模型进行垂线偏差补偿分析,北京航空航天大学王晶等发表论文“An OnlineGravity Modeling Method Applied for High Precision Free-INS”,提出了一种简化的二维二阶多项式模型,补偿了导航位置误差,但主要是进行了垂线偏差对导航解算的影响分析,对初始对准的补偿研究较少,且现有的补偿初始对准的方法都是在以椭球法线为天向的导航坐标系下进行补偿解算的,而加速度计实测的是真垂线方向上的真实重力,在算法上存在补偿解算的坐标系与测量器件实测的坐标系不一致的情况,影响初始对准性能。申请号为201410697203.0,201710894464.5的中国专利都采用EGM2008重力场球谐模型计算垂线偏差数据,但采用以椭球法线为天向的导航坐标系下进行补偿解算,存在坐标系不一致的情况,影响对准性能。海军工程大学常路宾等在2019年IEEE仪器与测量杂志发表论文“Gravity Disturbance Compensation for Inertial Navigation System”,分析了水平重力扰动补偿惯性导航系统中,垂线偏差和加速度计误差的耦合关系和补偿后位置精度的提升,但并有直接分析垂线偏差补偿后对惯性导航系统初始对准性能的提升问题。
发明内容
针对上述技术现状,本发明的目的在于提供一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法,采用最新发布的EIGEN-6C4重力场球谐模型计算垂线偏差,在以真垂线方向为天向的导航坐标系下解算载体的方位角,提高惯性导航系统初始对准精度和性能。
现将本发明技术解决方案叙述如下:
根据上述发明目的,本发明提供一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法,所述的重力场球谐模型补偿垂线偏差的惯导自对准方法是指凝固坐标系的垂线偏差补偿粗对准和补偿卡尔曼滤波精对准相结合的方法,其特征在于:利用高精度重力场球谐模型EIGEN-6C4直接计算对准点的重力扰动值在n系下的分量,并利用四元数法将其投影至导航坐标系n′系下进行补偿,最终求得载体天文方位角,提高对准性能,具体包括以下步骤:
步骤1:在惯导自对准开始前,利用转台对惯性导航系统进行标定,精确地估计出陀螺常值漂移和加速度计常值零偏,并在输出数据中扣除相应常值误差;
步骤2:定义导航坐标系n系和n′系,n系表示以参考椭球面法线为天向建立的东北天坐标系,n′系表示以真垂线方向(真实重力方向)为天向建立的东北天导航坐标系,静基座初始对准时,载体位置坐标精确已知,地理纬度L,经度λ,高程h,通过WGS-84正常重力模型计算初始对准点的正常重力矢量γn;
γn=[0 0 -γ]T (1)
步骤3:构建EIGEN-6C4高精度重力场球谐模型,输入惯性导航系统初始对准点纬度L、经度λ和高程h,计算重力扰动在n系下的分量δgn,补偿重力扰动后,可得真实重力矢量在n系下的投影为gn;
gn=γn+δg (2)
步骤4:将步骤3计算得出的补偿重力扰动后的矢量gn绕旋转轴u转动角度θ后,得到导航坐标系n′系下的真实重力扰动矢量gn′=[0 0 -g]T,具体通过以下步骤实现;
gn′=Cn ′ng (4)
步骤6.1:in′0为凝固导航坐标系,表示对准初始时刻的导航坐标系n′,相对惯性空间保持不变;反映了n′系相对in′0系的转动,其可根据载体所在位置的纬度信息L及时间间隔t计算得到;表示载体相对凝固载体坐标系的运动,其初值为单位矩阵, 可由陀螺输出利用四元数法实时更新得到;
步骤7:将补偿后的真实重力矢量gn′用于基于卡尔曼滤波的精对准方法中;
附图说明
图1:导航坐标系n系n′系及垂线偏差补偿后的重力矢量示意图
图2:本发明所述的一种补偿垂线偏差的惯导自对准方法流程图
图3:静基座对准试验中使用本发明方法的方位角误差补偿效果
具体实施方式
现结合附图对本发明的具体实施方式作进一步说明。
本发明的基本构思是,通过EIGEN-6C4高精度重力场球谐模型计算重力扰动矢量,将其补偿进正常重力矢量中,并将补偿后的重力矢量gn转化至导航坐标系n′系,得到真实重力矢量gn′;在此基础上,将补偿后的真实重力矢量应用于基于凝固坐标系的粗对准和卡尔曼滤波的精对准过程当中,最终解算载体天文方位角,该解算过程均在导航坐标系n′系下进行。
下面结合附图通过实施例对本发明的技术方案进行详细的描述。
步骤1:在惯导自对准开始前,利用转台对惯性导航系统进行标定,精确地估计出陀螺常值漂移和加速度计常值零偏,并在输出数据中扣除相应常值误差;
步骤2:如图1所示,定义导航坐标系n系和n′系,n系坐标原点为载体所处位置,xn轴与yn轴在当地椭球切平面内,分别指向东和北,zn轴与载体所处位置的参考椭球法线共线,指向天,三轴满足右手正交定律,参考椭球选取WGS-84椭球模型;n′系坐标原点在载体所处位置,xn′轴与yn′轴在当地水平面内,分别指向东和北极点,zn′轴与载体所处位置的垂线共线,即与真实重力矢量gn′共线,三轴指向满足右手正交定律。定义载体坐标系b系,其坐标原点在惯性导航系统质心,其三轴指向分别沿惯性导航系统的俯仰轴、横滚轴和航向轴。初始对准点纬度L、经度λ和高程h由GPS精确已知,通过WGS-84正常重力模型计算初始对准点的正常重力矢量γn;
γn=[0 0 -γ]T (1)
γ=9.7803267714×(1+5.27904×10-3×sin2L+2.97381×10-5sin4L)-3.0877×10-6×h
gn=γn+δgn (2)
步骤4:将步骤3计算得出的补偿重力扰动后的矢量gn绕旋转轴u转动角度θ后,得到导航坐标系n′系下的真实重力扰动矢量gn′=[0 0 -g]T,具体通过以下步骤实现;
步骤6.1:ib0为凝固载体坐标系,其表示对准初始时刻的载体坐标系,相对惯性空间保持不变;in′0为凝固导航坐标系,表示对准初始时刻的导航坐标系n′,相对惯性空间保持不变;反映了n′系相对in′0系的转动,其可根据载体所在位置的纬度信息L及时间间隔t计算得到;表示载体相对凝固载体坐标系的运动,其初值为单位矩阵, 可由陀螺输出利用四元数法实时更新得到。
卡尔曼滤波器状态方程及量测方程如下:
卡尔曼滤波器状态矩阵如下:
式中,L、h分别为惯性导航系统所在地的纬度和高度,RN和RM分别是惯性导航系统所在地的卯酉圈曲率半径和子午圈曲率半径。
G(t)=[01×3 δgn′T 01×6]T (14)
静基座初始对准中,选取惯性导航系统速度输出值作为量测量。
H=[03×3 I3×3 03×6] (18)
将本发明的补偿方法用于静基座捷联惯性导航系统初始对准过程中,由摆式陀螺寻北仪测量捷联惯性导航系统航向角作为理论真值,补偿前和补偿后的航向角误差如图3所示,实线为未补偿垂线偏差前的方位角误差,虚线为经本方法补偿后的方位角误差,可以看出经本发明补偿后,初始对准方位角误差明显降低,对准性能明显提高,未补偿前航向角误差为35.3″,经本发明补偿后,航向角误差降为28.6″。
Claims (3)
1.一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法,所述的重力场球谐模型补偿垂线偏差的惯导自对准方法是指凝固坐标系的垂线偏差补偿粗对准和补偿卡尔曼滤波精对准相结合的方法,其特征在于:利用高精度重力场球谐模型直接计算对准点的重力扰动值在n系下的分量,并利用四元数法将其投影至导航坐标系n′系下进行补偿,最终求得载体天文方位角,提高对准性能,具体包括以下步骤:
步骤1:在惯导自对准开始前,利用转台对惯性导航系统进行标定,精确地估计出陀螺常值漂移和加速度计常值零偏,并在输出数据中扣除相应常值误差;
步骤2:定义导航坐标系n系和n′系,n系表示以参考椭球面法线为天向建立的东北天坐标系,n′系表示以真垂线方向(真实重力方向)为天向建立的东北天导航坐标系,静基座初始对准时,载体位置坐标精确已知,地理纬度L,经度λ,高程h,通过正常重力模型计算初始对准点的正常重力矢量γn;
γn=[0 0 -γ]T (1)
步骤3:构建高精度重力场球谐模型,输入惯性导航系统初始对准点纬度L、经度λ和高程h,计算重力扰动在n系下的分量δgn,补偿重力扰动后,可得真实重力矢量在n系下的投影为gn;
gn=γn+δg (2)
步骤4:将步骤3计算得出的补偿重力扰动后的矢量gn绕旋转轴u转动角度θ后,得到导航坐标系n′系下的真实重力扰动矢量gn′=[0 0 -g]T;
步骤6.1:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011110959.2A CN112798014A (zh) | 2020-10-16 | 2020-10-16 | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011110959.2A CN112798014A (zh) | 2020-10-16 | 2020-10-16 | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112798014A true CN112798014A (zh) | 2021-05-14 |
Family
ID=75806150
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011110959.2A Pending CN112798014A (zh) | 2020-10-16 | 2020-10-16 | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112798014A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885101A (zh) * | 2021-09-28 | 2022-01-04 | 中国船舶重工集团公司第七0七研究所 | 一种基于椭球模型构建重力梯度基准图方法 |
CN115077520A (zh) * | 2022-08-22 | 2022-09-20 | 中国船舶重工集团公司第七0七研究所 | 一种基于谐振惯导系统的姿态补偿方法 |
CN115326109A (zh) * | 2022-09-14 | 2022-11-11 | 中国人民解放军火箭军工程大学 | 一种基于路径实测重力异常补偿的垂线偏差测量方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN104061945A (zh) * | 2014-06-30 | 2014-09-24 | 中国人民解放军国防科学技术大学 | 基于ins和gps组合的垂线偏差动态测量装置及方法 |
CN107677292A (zh) * | 2017-09-28 | 2018-02-09 | 中国人民解放军国防科技大学 | 基于重力场模型的垂线偏差补偿方法 |
CN109186591A (zh) * | 2018-08-28 | 2019-01-11 | 贵州理工学院 | 一种基于系统状态估计的sins/gps高精度重力扰动补偿方法 |
US20200309564A1 (en) * | 2017-12-22 | 2020-10-01 | Mohammad Shakibay Senobari | Initializing an inertial measurement unit |
-
2020
- 2020-10-16 CN CN202011110959.2A patent/CN112798014A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN104061945A (zh) * | 2014-06-30 | 2014-09-24 | 中国人民解放军国防科学技术大学 | 基于ins和gps组合的垂线偏差动态测量装置及方法 |
CN107677292A (zh) * | 2017-09-28 | 2018-02-09 | 中国人民解放军国防科技大学 | 基于重力场模型的垂线偏差补偿方法 |
US20200309564A1 (en) * | 2017-12-22 | 2020-10-01 | Mohammad Shakibay Senobari | Initializing an inertial measurement unit |
CN109186591A (zh) * | 2018-08-28 | 2019-01-11 | 贵州理工学院 | 一种基于系统状态估计的sins/gps高精度重力扰动补偿方法 |
Non-Patent Citations (1)
Title |
---|
SHIWEN HAO ET.AL: "nalysis of Gravity Disturbance Compensation for Initial Alignment of INS", 《IEEE ACCESS》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885101A (zh) * | 2021-09-28 | 2022-01-04 | 中国船舶重工集团公司第七0七研究所 | 一种基于椭球模型构建重力梯度基准图方法 |
CN113885101B (zh) * | 2021-09-28 | 2023-12-12 | 中国船舶重工集团公司第七0七研究所 | 一种基于椭球模型构建重力梯度基准图方法 |
CN115077520A (zh) * | 2022-08-22 | 2022-09-20 | 中国船舶重工集团公司第七0七研究所 | 一种基于谐振惯导系统的姿态补偿方法 |
CN115326109A (zh) * | 2022-09-14 | 2022-11-11 | 中国人民解放军火箭军工程大学 | 一种基于路径实测重力异常补偿的垂线偏差测量方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN103808331B (zh) | 一种mems三轴陀螺仪误差标定方法 | |
CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN102749079B (zh) | 一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN101571394A (zh) | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 | |
CN103743413B (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN110887507B (zh) | 一种快速估计惯性测量单元全部零偏的方法 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN110672131B (zh) | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 | |
CN113311436A (zh) | 一种移动平台上激光测风雷达运动姿态测风订正方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 | |
CN106052686B (zh) | 基于dsptms320f28335的全自主捷联惯性导航系统 | |
CN106525073A (zh) | 一种基于三轴转台的惯性空间陀螺标定试验方法 | |
CN108195400A (zh) | 捷联式微机电惯性导航系统的动基座对准方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN112798014A (zh) | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 | |
CN106940193A (zh) | 一种基于Kalman滤波的船舶自适应摇摆标定方法 | |
CN105371844A (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
Guo et al. | Calibration and compensation of the scale factor errors in DTG POS | |
CN113503892B (zh) | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 | |
CN115079287B (zh) | 陀螺组件姿态观测的捷联式车载动态重力矢量测量方法 | |
CN117053802A (zh) | 一种基于旋转mems imu的车载导航系统定位误差减小的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210514 |