CN108279025B - 一种基于重力信息的光纤陀螺罗经快速精对准方法 - Google Patents
一种基于重力信息的光纤陀螺罗经快速精对准方法 Download PDFInfo
- Publication number
- CN108279025B CN108279025B CN201711406757.0A CN201711406757A CN108279025B CN 108279025 B CN108279025 B CN 108279025B CN 201711406757 A CN201711406757 A CN 201711406757A CN 108279025 B CN108279025 B CN 108279025B
- Authority
- CN
- China
- Prior art keywords
- alignment
- matrix
- formula
- compass
- coordinate system
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 230000005484 gravity Effects 0.000 title claims abstract description 30
- 239000011159 matrix material Substances 0.000 claims abstract description 40
- 238000001914 filtration Methods 0.000 claims abstract description 17
- 230000015271 coagulation Effects 0.000 claims abstract description 4
- 238000005345 coagulation Methods 0.000 claims abstract description 4
- 238000007711 solidification Methods 0.000 claims description 4
- 230000008023 solidification Effects 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract description 4
- 238000012360 testing method Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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
本发明涉及一种基于重力信息的光纤陀螺罗经快速精对准方法,其特征在于:包括以下步骤:步骤1、定义坐标系;步骤2、将p系到n系的姿态矩阵分解,并逐级求解;步骤3、设计精对准卡尔曼滤波器;步骤4、设定滤波观测量Z;步骤5、利用步骤3设计的精对准卡尔曼滤波器和步骤4设定的观测量精完成精对准。本发明通过巧妙地构造惯性系速度观测信息进行开环卡尔曼滤波,直接在惯性凝固坐标系中进行精对准,实测结果表明可以在复杂环境中实现光纤陀螺罗经快速对准。
Description
技术领域
本发明属于光纤陀螺罗经初始对准中精对准技术领域,涉及光纤陀螺罗经精对准方法,尤其是一种基于重力信息的光纤陀螺罗经快速精对准方法。
背景技术
光纤陀螺罗经是随着光纤陀螺技术成熟出现的一种新型罗经,可以为船舶操纵及稳定控制提供艏向、水平姿态及旋转角速率等信息,以其启动快、免维护、可靠性高、全寿命使用成本低等优点逐步受到市场的认可,将取代电罗经。目前,精确快速的初始对准技术为光纤陀螺罗经关键技术之一,直接影响***精度。
初始对准一般分为粗对准及精对准两阶段,粗对准目的是短时间内获得粗略的姿态信息,精对准阶段再对粗对准得到的信息进行修正。传统初始对准方法的原理大都可以归结为使用地球自转矢量和重量矢量在导航坐标系的测量值进行双矢量定姿。当前对陀螺罗经初始对准时间的要求越来越短,但由于外界环境复杂以及惯性元件噪声等原因,尤其在船舶晃动时,干扰角速度可能比地球自转角速度高好几个数量级,要达到高精度对准要求,需要的时间较长。
经研究发现,通过观测重力矢量在惯性系中由于地球自转而随时间变化的特点可以确定地理北向。目前已有较多学者基于该思路设计了粗对准算法,有效提升了粗对准的精度及抗干扰程度,但由于传统对准算法仅将观测重力矢量在惯性系内旋转的思路应用于粗对准算法,虽有效地提升了粗对准的精度及抗干扰程度,但精对准仍沿用传统方法在在当地地理坐标系修正粗对准误差角,对准速度及抗干扰程度仍不理想,亟需一种新的光纤陀螺罗经快速精对准方法。
发明内容
本发明的目的在于提供一种设计合理、对准速度快且抗干扰程度强的
本发明解决其现实问题是采取以下技术方案实现的:
一种基于重力信息的光纤陀螺罗经快速精对准方法,包括以下步骤:
步骤1、定义坐标系:n系为导航坐标系,采用当地地理坐标系ENU;e系为地球坐标系;在初始对准起始时刻,将e系在惯性空间内凝固成为i0,i0′为计算惯性凝固坐标系;p系为载体坐标系;ip0系为载体惯性凝固坐标系;在初始对准起始时刻,将p系在惯性空间凝固成为ip0;
步骤2、将p系到n系的姿态矩阵分解,并逐级求解;
步骤3、设计精对准卡尔曼滤波器;
步骤4、设定滤波观测量Z;
步骤5、利用步骤3设计的精对准卡尔曼滤波器和步骤4设定的观测量精完成精对准。
而且,所述步骤2的具体步骤包括:
而且,所述步骤3的具体步骤包括:
(1)建立离散Kalman滤波的基本方程为:
(2)构造12维状态矢量X:
(3)建立12维状态空间方程:
其中,A(t)、G(t)分别为t时刻状态矩阵和***噪声驱动矩阵;fp为加速度计输出;W为正态分布的高斯白噪声。
(4)采用速度匹配算法,建立观测方程为:
Z=HX+V
式中,观测量噪声序列V~N(0,R);
观测矩阵H为H=[03×3 I3×3 03×3 03×3];
(5)设置卡尔曼滤波器参数
状态方差初始值P0为:
P0=diag{(5°)2(5°)2(5°)2(2m/s)2(2m/s)2(2m/s)2(0.02°/h)2
(0.02°/h)2(0.02°/h)2(1mg)2(1mg)2(1mg)2}
***噪声序列协方差Q为:
Q=diag{(0.02°/h)2(0.02°/h)2(0.02°/h)2(1mg)2(1mg)2(1mg)2}
观测噪声协方差R为:
R=diag{(0.1m/s)2(0.1m/s)2(0.1m/s)2}
而且,所述步骤5的具体步骤包括:
(4)计算滤波观测量Z;
(6)判断精对准时间是否结束,如果已经结束则转到步骤5的第(7)步,未结束则继续步骤5的第(3)步;
(8)利用步骤2中p系到n系的姿态矩阵公式得到姿态矩阵,完成精对准,从而完成初始对准。
本发明的优点和有益效果:
本发明针对现有精对准技术局限,提供一种观测重力矢量在惯性系的缓慢漂移的旋转来实现快速精对准的方法,通过巧妙地构造惯性系速度观测信息进行开环卡尔曼滤波,直接在惯性凝固坐标系中进行精对准,实测结果表明可以在复杂环境中实现光纤陀螺罗经快速对准。
附图说明
图1为本发明的算法流程图;
图2为本发明的车载试验初始对准水平姿态角估计值图;
图3为本发明的车载试验初始对准航向角估计值误差图。
具体实施方式
以下结合附图对本发明实施例作进一步详述:
一种基于重力信息的光纤陀螺罗经快速精对准方法,如图1所示,包括以下步骤:
步骤1、定义坐标系:n系为导航坐标系,采用当地地理坐标系ENU;e系为地球坐标系;在初始对准起始时刻,将e系在惯性空间内凝固成为i0,i0′为计算惯性凝固坐标系;p系为载体坐标系;ip0系为载体惯性凝固坐标系;在初始对准起始时刻,将p系在惯性空间凝固成为ip0;
步骤2、将p系到n系的姿态矩阵分解,并逐级求解;
所述步骤2的具体步骤包括:
步骤3、设计精对准卡尔曼滤波器;
所述步骤3的具体步骤包括:
(1)建立离散Kalman滤波的基本方程为:
(2)构造12维状态矢量X:
(3)建立12维状态空间方程:
其中,A(t)、G(t)分别为t时刻状态矩阵和***噪声驱动矩阵;fp为加速度计输出;W为正态分布的高斯白噪声。
(4)采用速度匹配算法,建立观测方程为:
Z=HX+V (7)
式中,观测量噪声序列V~N(0,R);
观测矩阵H为H=[03×3 I3×3 03×3 03×3];
(5)设置卡尔曼滤波器参数
状态方差初始值P0为:
***噪声序列协方差Q为:
Q=diag{(0.02°/h)2(0.02°/h)2(0.02°/h)2(1mg)2(1mg)2(1mg)2} (9)
观测噪声协方差R为:
R=diag{(0.1m/s)2(0.1m/s)2(0.1m/s)2} (10)
步骤4、设定滤波观测量
步骤5、利用步骤3设计的精对准卡尔曼滤波器和步骤4设定的观测量精完成精对准;
所述步骤5的具体步骤包括:
(4)按照公式(11)计算滤波观测量Z;
(6)判断精对准时间是否结束,如果已经结束则转到步骤(7),未结束则继续步骤(3);
(8)利用公式(1)得到姿态矩阵,完成精对准,从而完成初始对准。
本发明的工作原理为:
本发明的一种基于重力信息的光纤陀螺罗经快速精对准方法,包括以下步骤:步骤1、公开了本发明精对准方法使用的坐标系定义;步骤2、公开了本发明精对准方法开始前的准备工作,包括姿态矩阵求解;步骤3、公开了本发明精对准方法使用的状态方程、观测方程及卡尔曼滤波器参数设置;步骤4、公开了本发明精对准方法速度观测量的构造方法;步骤5、公开了本发明精对准方法算法流程实例。
本发明使用基于重力信息的粗对准得到的估计值通过陀螺输出角速度跟踪p系相对于ip0系的变化,有效隔离载体运动;将重力矢量g在i0中投影,观测到地球自转引起重力矢量g在i0内以地球自转轴为主轴的锥面内旋转,从其旋转中提取地球自转信息;利用加速度计输出构成重力矢量测量值作为滤波观测值;以i0系对地速度为观测量通过卡尔曼滤波方法估出粗对准确定的i0′系相对于i0的误差角并进行修正,完成***的初始对准。
为验证本发明提出的方法,使用某型艏向精度为9′(RMS),水平姿态精度为3′(RMS)的光纤陀螺罗经***,进行了初始对准车载验证试验。对准期间发动机可以开启,试验人员可以自由上下车,主要考察***航向角精度,将经纬仪的测量值作为***真实航向。对准结束后断电重启***再次进行对准。在多个方位进行了多次初始对准试验,统计艏向角精度RMS统计优于7′,对准时间小于5min。图2为某次对准试验水平姿态角估计值曲线。水平姿态角快速收敛,但是由于各种干扰存在振动,在载车上没有参照的情况下水平精度无法直接考核。离线仿真中,初始对准完成后转纯惯性导航5min,通过纯惯性导航水平速度推算水平姿态角对准精度,统计发现水平对准精度RMS统计优于3′。图3为该次对准试验精对准阶段的航向角估计值误差曲线。结合图2、图3可以看出,在载车存在晃动情况下,经5min初始对准后航向误差角收敛到稳态值附近。
需要强调的是,本发明所述实施例是说明性的,而不是限定性的,因此本发明包括并不限于具体实施方式中所述实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (4)
1.一种基于重力信息的光纤陀螺罗经快速精对准方法,其特征在于:包括以下步骤:
步骤1、定义坐标系:n系为导航坐标系,采用当地地理坐标系ENU;e系为地球坐标系;在初始对准起始时刻,将e系在惯性空间内凝固成为i0,i0′为计算惯性凝固坐标系;p系为载体坐标系;ip0系为载体惯性凝固坐标系;在初始对准起始时刻,将p系在惯性空间凝固成为ip0;
步骤2、将p系到n系的姿态矩阵分解,并逐级求解;
步骤3、设计精对准卡尔曼滤波器;
步骤4、设定滤波观测量Z;
步骤5、利用步骤3设计的精对准卡尔曼滤波器和步骤4设定的观测量精完成精对准。
3.根据权利要求1或2所述的一种基于重力信息的光纤陀螺罗经快速精对准方法,其特征在于:所述步骤3的具体步骤包括:
(1)建立离散Kalman滤波的基本方程为:
(2)构造12维状态矢量X:
(3)建立12维状态空间方程:
其中,A(t)、G(t)分别为t时刻状态矩阵和***噪声驱动矩阵;fp为加速度计输出;W为正态分布的高斯白噪声;
(4)采用速度匹配算法,建立观测方程为:
Z=HX+V
式中,观测量噪声序列V~N(0,R);
观测矩阵H为H=[03×3 I3×3 03×3 03×3];
(5)设置卡尔曼滤波器参数
状态方差初始值P0为:
P0=diag{(5°)2(5°)2(5°)2(2m/s)2(2m/s)2(2m/s)2(0.02°/h)2(0.02°/h)2(0.02°/h)2(1mg)2(1mg)2(1mg)2}
***噪声序列协方差Q为:
Q=diag{(0.02°/h)2(0.02°/h)2(0.02°/h)2(1mg)2(1mg)2(1mg)2}
观测噪声协方差R为:
R=diag{(0.1m/s)2(0.1m/s)2(0.1m/s)2}。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711406757.0A CN108279025B (zh) | 2017-12-22 | 2017-12-22 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711406757.0A CN108279025B (zh) | 2017-12-22 | 2017-12-22 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108279025A CN108279025A (zh) | 2018-07-13 |
CN108279025B true CN108279025B (zh) | 2020-05-19 |
Family
ID=62802122
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711406757.0A Active CN108279025B (zh) | 2017-12-22 | 2017-12-22 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108279025B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262479A (zh) * | 2019-05-28 | 2019-09-20 | 南京天辰礼达电子科技有限公司 | 一种履带式拖拉机运动学估计及偏差校准方法 |
CN114966877B (zh) * | 2022-05-12 | 2024-05-14 | 中国人民解放军海军工程大学 | 一种重力矢量场建设方法、***、介质、设备及终端 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101576385A (zh) * | 2009-06-22 | 2009-11-11 | 哈尔滨工程大学 | 光纤陀螺捷联惯导***消除不确定性干扰的精对准方法 |
CN101963512A (zh) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | 船用旋转式光纤陀螺捷联惯导***初始对准方法 |
CN102305635A (zh) * | 2011-08-08 | 2012-01-04 | 东南大学 | 一种光纤捷联罗经***的对准方法 |
-
2017
- 2017-12-22 CN CN201711406757.0A patent/CN108279025B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101576385A (zh) * | 2009-06-22 | 2009-11-11 | 哈尔滨工程大学 | 光纤陀螺捷联惯导***消除不确定性干扰的精对准方法 |
CN101963512A (zh) * | 2010-09-03 | 2011-02-02 | 哈尔滨工程大学 | 船用旋转式光纤陀螺捷联惯导***初始对准方法 |
CN102305635A (zh) * | 2011-08-08 | 2012-01-04 | 东南大学 | 一种光纤捷联罗经***的对准方法 |
Non-Patent Citations (1)
Title |
---|
基于矢量定姿的捷联惯性系对准误差分析;郑振宇等;《海军工程大学学报》;20170630;第29卷(第3期);第76-81、86页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108279025A (zh) | 2018-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104181574B (zh) | 一种捷联惯导***/全球导航卫星***组合导航滤波***及方法 | |
CN106871928B (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN101413800B (zh) | 导航/稳瞄一体化***的导航、稳瞄方法 | |
CN103743395B (zh) | 一种惯性重力匹配组合导航***中时间延迟的补偿方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN110398257A (zh) | Gps辅助的sins***快速动基座初始对准方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN105318876A (zh) | 一种惯性里程计组合高精度姿态测量方法 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 | |
CN101900573B (zh) | 一种实现陆用惯性导航***运动对准的方法 | |
CN111982106A (zh) | 导航方法、装置、存储介质及电子装置 | |
CN112432642B (zh) | 一种重力灯塔与惯性导航融合定位方法及*** | |
CN109931955A (zh) | 基于状态相关李群滤波的捷联惯性导航***初始对准方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN103245357A (zh) | 一种船用捷联惯导***二次快速对准方法 | |
CN108279025B (zh) | 一种基于重力信息的光纤陀螺罗经快速精对准方法 | |
CN114964222A (zh) | 一种车载imu姿态初始化方法、安装角估计方法及装置 | |
CN111220151B (zh) | 载体系下考虑温度模型的惯性和里程计组合导航方法 | |
Zorina et al. | Enhancement of INS/GNSS integration capabilities for aviation-related applications | |
CN113959462A (zh) | 一种基于四元数的惯性导航***自对准方法 | |
CN104949687A (zh) | 一种长时间导航***全参数精度评估方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |