CN111735442A - 一种水下重力无源导航系统 - Google Patents
一种水下重力无源导航系统 Download PDFInfo
- Publication number
- CN111735442A CN111735442A CN202010553987.5A CN202010553987A CN111735442A CN 111735442 A CN111735442 A CN 111735442A CN 202010553987 A CN202010553987 A CN 202010553987A CN 111735442 A CN111735442 A CN 111735442A
- Authority
- CN
- China
- Prior art keywords
- gravity
- navigation system
- underwater
- computer
- passive
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开一种水下重力无源导航系统,它由激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪、深度计、数字重力异常图、3个计算机、数据采集处理平台和LCD显示组成。根据激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪和深度计信息,计算出重力无源导航系统的位置、速度、姿态和重力值。利用存储在计算机中的数字重力异常图,取相邻两点实测重力变化量与数字重力异常图上对应两点重力变化量差的平方和作为性能指标,进行相关计算,使性能指标最小的点位置为水下重力无源导航系统最优估计位置。本发明提供一种水下重力无源导航系统,它能够满足水下运载体长航时、高精度、低成本的导航需求。
Description
技术领域
本发明涉及一种水下重力无源导航系统,属于组合导航技术领域。
背景技术
探索和开发海洋对沿海国家的经济发展和国家安全起着非常重要的作用,水下重力无源导航具有长航时、高精度和隐蔽性好的特点,受到各海洋大国的高度重视。上世纪80年代美国研制出含有通用重力敏感模块的无源导航系统,但是成本非常昂贵。随着惯性技术的迅猛发展,陀螺仪和加速度计的测量精度得到大幅度的提高,为了满足水下运载体长航时、高精度、低成本的导航需求,本发明提供了一种水下重力无源导航系统。
发明内容
本发明的目的是为了解决水下运载体长航时、高精度、低成本的导航需求,提供了一种水下重力无源导航系统。
为了达到上述目的,本发明采用的技术方案是:一种水下重力无源导航系统,包括激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪、深度计、数字重力异常图、3个计算机、数据采集处理平台以及LCD显示装置;所述的激光陀螺单轴旋转捷联惯性导航系统、电磁计程仪、深度计、计算机和数据采集处理平台组成水下组合导航系统,电磁计程仪的速度信息和深度计的水深信息作为水下组合导航系统的外观测量,应用扩展卡尔曼滤波,计算出水下组合导航系统位置;所述的光纤陀螺捷联式重力仪、水下组合导航系统、计算机和数据采集处理平台和LCD显示装置组成水下重力测量系统;水下组合导航系统的位置信息、电磁计程仪的速度信息和深度计的水深信息作为水下重力测量系统的外观测量,应用扩展卡尔曼滤波,计算出水下重力测量系统位置、速度、姿态、以及当地地理坐标系下的加速度计比力;对加速度计比力进行重力测量改正和低通滤波处理,得到当地重力值;所述的数字重力异常图存储在计算机中,取相邻两点实测重力变化量与数字重力异常图上对应两点重力变化量的差平方和作为性能指标,进行相关计算,使性能指标最小的点位置就是水下重力无源导航系统的最优估计位置。
作为本发明的一种改进,所述的3个计算机中,其中1个计算机进行水下组合导航系统的位置、速度和姿态计算,1个计算机进行水下重力测量系统的位置、速度、姿态和重力值计算,1个计算机存储重力异常图和进行水下重力无源导航系统的最优估计计算。
作为本发明的一种改进,所述的计算机采用FPGA+DSP+ARM架构。
有益效果
本发明公开一种水下重力无源导航系统,它由激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪、深度计、数字重力异常图、3个计算机、数据采集处理平台和LCD显示组成。光纤陀螺捷联式重力仪、水下组合导航系统、计算机和数据采集处理平台和LCD显示组成水下重力测量系统;水下组合导航系统的位置信息、电磁计程仪的速度信息和深度计的水深信息作为水下重力测量系统的外观测量,应用扩展卡尔曼滤波,计算出水下重力测量系统的位置、速度、姿态、以及当地地理坐标系下的加速度计比力;对加速度计比力进行重力测量改正和低通滤波处理,得到当地重力值。利用存储在计算机中的数字重力异常图,取相邻两点实测重力变化量与数字重力异常图上对应两点重力变化量的差平方和作为性能指标,进行相关计算,使性能指标最小的点位置就是水下重力无源导航系统的最优估计位置。本发明提供的一种水下重力无源导航系统能够满足水下运载体长航时、高精度、低成本的导航需求。
附图说明
图1为本发明的水下重力无源导航系统示意图;
图2为本发明的激光陀螺单轴旋转捷联惯性导航算法流程图;
图3为本发明水下组合导航系统导航算法流程图;
图4为本发明水下重力测量系统算法流程图。
具体实施方式
下面结合具体实施例对本发明作进一步地说明。
本实施例公开了一种水下重力无源导航系统,由水下重力无源导航系统由激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪、深度计、数字重力异常图、3个计算机、数据采集处理平台和LCD显示组成,如图1所示。
激光陀螺单轴旋转捷联惯性导航系统主要由三个90型二频机抖激光陀螺仪、三个高精度摆式挠性加速度计、转位机构和电路板等组成。
光纤陀螺捷联式重力仪主要由三个高精度光纤陀螺仪、三个高精度摆式挠性加速度计、精密温控装置和电路板等组成。
数据采集处理平台实时处理和存储激光陀螺单轴旋转捷联惯性导航系统、电磁计程仪、深度计、光纤陀螺捷联式重力仪的输出信息。
导航计算机采用FPGA+DSP+ARM架构,水下重力无源导航系统有3个计算机,一个计算机进行水下组合导航系统的位置、速度和姿态计算,1个计算机进行水下重力测量系统的位置、速度、姿态和重力值计算,1个计算机存储重力异常图和进行水下重力无源导航系统的最优估计计算。
激光陀螺单轴旋转捷联惯性导航系统算法如图2所示。加速度计输出通过误差补偿后,经坐标转换从转位坐标系变换到载体坐标系,然后通过姿态转换变换到导航坐标系下,积分得到速度和位置;陀螺仪输出通过误差补偿后,经坐标转换从转位坐标系变换到载体坐标系,利用导航系旋转角速度和地球自转角速度,通过四元数算法得到姿态阵,最后得到姿态角。转位坐标系到载体坐标系的变换关系由转位机构旋转角度确定。
水下组合导航系统算法如图3所示。通过电磁计程仪的速度信息和深度计的水深信息,利用扩展卡尔曼滤波,估计出激光陀螺单轴旋转捷联惯性导航系统的位置、速度和姿态误差,经误差补偿后得到水下组合导航系统的位置、速度和姿态。
水下重力测量系统导航算法如图4所示。通过水下组合导航系统的位置信息、电磁计程仪的速度信息和深度计的水深信息,利用扩展卡尔曼滤波,计算出水下重力测量系统的位置、速度、姿态、以及当地地理坐标系下的加速度计比力。
对加速度计比力进行重力测量改正,如厄特弗斯改正,零点漂移改正、滞后效应改正等,对改正后的数据进行Fir低通滤波处理,得到当地重力值。
水下重力测量系统实测重力值用gt表示,数字重力异常图上得到的重力值用gm表示。取相邻两点实测重力变化量与数字重力异常图上对应两点重力变化量差的平方和J(j)作为性能指标
其中,j表示第j路径,N表示点数。
对式(1)作相关极值计算,使式(1)最小的点轨迹为最优轨迹。最优轨迹点的位置就是水下重力无源导航系统的最优估计位置。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和等同替换,这些对本发明权利要求进行改进和等同替换后的技术方案,均落入本发明的保护范围。
Claims (3)
1.一种水下重力无源导航系统,其特征在于:包括激光陀螺单轴旋转捷联惯性导航系统、光纤陀螺捷联式重力仪、电磁计程仪、深度计、数字重力异常图、3个计算机、数据采集处理平台以及LCD显示装置;所述的激光陀螺单轴旋转捷联惯性导航系统、电磁计程仪、深度计、计算机和数据采集处理平台组成水下组合导航系统,电磁计程仪的速度信息和深度计的水深信息作为水下组合导航系统的外观测量,应用扩展卡尔曼滤波,计算出水下组合导航系统位置;所述的光纤陀螺捷联式重力仪、水下组合导航系统、计算机和数据采集处理平台和LCD显示装置组成水下重力测量系统;水下组合导航系统的位置信息、电磁计程仪的速度信息和深度计的水深信息作为水下重力测量系统的外观测量,应用扩展卡尔曼滤波,计算出水下重力测量系统位置、速度、姿态、以及当地地理坐标系下的加速度计比力;对加速度计比力进行重力测量改正和低通滤波处理,得到当地重力值;所述的数字重力异常图存储在计算机中,取相邻两点实测重力变化量与数字重力异常图上对应两点重力变化量的差平方和作为性能指标,进行计算,得到水下重力无源导航系统的最优估计位置。
2.根据权利要求1所述的一种水下重力无源导航系统,其特征在于:所述的3个计算机中,其中1个计算机进行水下组合导航系统的位置、速度和姿态计算,1个计算机进行水下重力测量系统的位置、速度、姿态和重力值计算,1个计算机存储重力异常图和进行水下重力无源导航系统的最优估计计算。
3.根据权利要求1所述的水下重力无源导航系统,其特征在于:所述的计算机采用FPGA+DSP+ARM架构。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010553987.5A CN111735442A (zh) | 2020-06-17 | 2020-06-17 | 一种水下重力无源导航系统 |
PCT/CN2020/099248 WO2021253488A1 (zh) | 2020-06-17 | 2020-06-30 | 一种水下重力无源导航系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010553987.5A CN111735442A (zh) | 2020-06-17 | 2020-06-17 | 一种水下重力无源导航系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111735442A true CN111735442A (zh) | 2020-10-02 |
Family
ID=72649553
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010553987.5A Pending CN111735442A (zh) | 2020-06-17 | 2020-06-17 | 一种水下重力无源导航系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN111735442A (zh) |
WO (1) | WO2021253488A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112762927A (zh) * | 2020-12-18 | 2021-05-07 | 中国人民解放军战略支援部队信息工程大学 | 水下动态重力数据采集半实物仿真方法及系统 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114353791B (zh) * | 2022-01-14 | 2023-11-10 | 中国人民解放军国防科技大学 | 基于未知洋流流速的组合导航方法及装置 |
CN116182854B (zh) * | 2023-04-28 | 2023-09-05 | 中国人民解放军海军工程大学 | 自适应鲁棒惯性/重力匹配组合导航方法、系统及终端 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101424534A (zh) * | 2008-12-09 | 2009-05-06 | 东南大学 | 惯性/重力组合导航半实物模拟装置 |
CN101769742A (zh) * | 2010-01-19 | 2010-07-07 | 东南大学 | 海洋惯性重力组合导航装置 |
CN102788578A (zh) * | 2012-07-25 | 2012-11-21 | 中国人民解放军海军工程大学 | 一种基于局部重力场逼近的匹配导航方法 |
CN109001829A (zh) * | 2018-07-12 | 2018-12-14 | 中国人民解放军国防科技大学 | 一种捷联式水下动态重力测量仪 |
WO2019122987A1 (en) * | 2017-12-22 | 2019-06-27 | Shakibay Senobari Mohammad | Accurate initialization of strapdown inertial navigation system |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5339684A (en) * | 1991-12-10 | 1994-08-23 | Textron Inc. | Gravity aided inertial navigation system |
CN103604430A (zh) * | 2013-11-06 | 2014-02-26 | 哈尔滨工程大学 | 一种基于边缘化ckf重力辅助导航的方法 |
CN103743395B (zh) * | 2014-01-17 | 2016-09-14 | 哈尔滨工程大学 | 一种惯性重力匹配组合导航系统中时间延迟的补偿方法 |
CN106405670B (zh) * | 2016-10-10 | 2018-06-19 | 北京航天控制仪器研究所 | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 |
CN108362281B (zh) * | 2018-02-24 | 2020-11-24 | 中国人民解放军61540部队 | 一种长基线水下潜艇匹配导航方法及系统 |
CN108896040B (zh) * | 2018-03-30 | 2021-03-26 | 中国空间技术研究院 | 天空海一体化水下潜器惯性/重力组合导航方法和系统 |
-
2020
- 2020-06-17 CN CN202010553987.5A patent/CN111735442A/zh active Pending
- 2020-06-30 WO PCT/CN2020/099248 patent/WO2021253488A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101424534A (zh) * | 2008-12-09 | 2009-05-06 | 东南大学 | 惯性/重力组合导航半实物模拟装置 |
CN101769742A (zh) * | 2010-01-19 | 2010-07-07 | 东南大学 | 海洋惯性重力组合导航装置 |
CN102788578A (zh) * | 2012-07-25 | 2012-11-21 | 中国人民解放军海军工程大学 | 一种基于局部重力场逼近的匹配导航方法 |
WO2019122987A1 (en) * | 2017-12-22 | 2019-06-27 | Shakibay Senobari Mohammad | Accurate initialization of strapdown inertial navigation system |
CN109001829A (zh) * | 2018-07-12 | 2018-12-14 | 中国人民解放军国防科技大学 | 一种捷联式水下动态重力测量仪 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112762927A (zh) * | 2020-12-18 | 2021-05-07 | 中国人民解放军战略支援部队信息工程大学 | 水下动态重力数据采集半实物仿真方法及系统 |
CN112762927B (zh) * | 2020-12-18 | 2021-09-10 | 中国人民解放军战略支援部队信息工程大学 | 水下动态重力数据采集半实物仿真方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
WO2021253488A1 (zh) | 2021-12-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN111735442A (zh) | 一种水下重力无源导航系统 | |
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN102636149B (zh) | 挠性体动态变形的组合测量装置及测量方法 | |
CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN109974697A (zh) | 一种基于惯性系统的高精度测绘方法 | |
CN102486377A (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN103512584A (zh) | 导航姿态信息输出方法、装置及捷联航姿参考系统 | |
US6904377B2 (en) | Method for measuring force-dependent gyroscope sensitivity | |
CN101183004A (zh) | 一种在线实时消除光纤陀螺捷联惯导系统振荡误差的方法 | |
CN103697878B (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN109916394A (zh) | 一种融合光流位置和速度信息的组合导航算法 | |
CN101769742A (zh) | 海洋惯性重力组合导航装置 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN104482941A (zh) | 一种船用光学惯导长航时保精度导航的系统级补偿方法 | |
CN112880669A (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN102168978A (zh) | 一种船用惯性导航系统摇摆基座开环对准方法 | |
CN104501809B (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
CN116448145A (zh) | 一种基于偏振矢量空间差分的航姿确定方法 | |
CN103630123A (zh) | 一种波浪传感器 | |
CN104567888A (zh) | 基于速度在线修正的惯性导航车辆姿态测量方法 | |
CN111812737B (zh) | 水下导航与重力测量一体化系统 | |
CN106679612B (zh) | 一种基于惯性测量匹配的非线性挠曲变形估计方法 | |
CN102183263A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20201002 |