CN111722295A - 一种水下捷联式重力测量数据处理方法 - Google Patents

一种水下捷联式重力测量数据处理方法 Download PDF

Info

Publication number
CN111722295A
CN111722295A CN202010632799.1A CN202010632799A CN111722295A CN 111722295 A CN111722295 A CN 111722295A CN 202010632799 A CN202010632799 A CN 202010632799A CN 111722295 A CN111722295 A CN 111722295A
Authority
CN
China
Prior art keywords
strapdown
gravity
underwater
data processing
processing method
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.)
Granted
Application number
CN202010632799.1A
Other languages
English (en)
Other versions
CN111722295B (zh
Inventor
蔡体菁
吴黎明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN202010632799.1A priority Critical patent/CN111722295B/zh
Priority to PCT/CN2020/101760 priority patent/WO2022006921A1/zh
Publication of CN111722295A publication Critical patent/CN111722295A/zh
Application granted granted Critical
Publication of CN111722295B publication Critical patent/CN111722295B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01VGEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
    • G01V7/00Measuring gravitational fields or waves; Gravimetric prospecting or detecting
    • G01V7/02Details
    • G01V7/06Analysis or interpretation of gravimetric records
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/18Stabilised platforms, e.g. by gyroscope

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geophysics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

本发明公开一种水下捷联式重力测量数据处理方法,包括对激光陀螺单轴旋转捷联惯性导航系统的位置进行误差估计与补偿,再经低通滤波器,得到准确的位置;以新的准确位置和计程仪的速度和深度计的水深作为捷联式重力仪的外观测量,应用扩展卡尔曼滤波,计算出当地地理坐标系下的加速度计比力值;经重力各项改正后,用正反综合卡尔曼滤波,得到当地重力异常值。本发明提供的一种水下捷联式重力测量数据处理方法,能够满足水下长时间、高精度、低成本的捷联式重力测量需求。

Description

一种水下捷联式重力测量数据处理方法
技术领域
本发明涉及一种水下捷联式重力测量数据处理方法,属于重力测量领域。
背景技术
水下重力测量对国民经济发展和国防建设具有重要意义。进行水下长时间大范围移动式重力测量需要准确的水下定位信息。随着科学技术的发展,激光陀螺单轴旋转捷联惯性导航系统依靠外界信息能够长时间地提供高精度的水下定位信息。针对由激光陀螺单轴旋转捷联惯性导航系统、计程仪、深度计、捷联式重力仪组成的水下捷联式重力测量系统,本发明提供了一种水下捷联式重力测量数据处理方法,它能够满足水下长时间、高精度、低成本的捷联式重力测量需求。
发明内容
本发明的目的是为了满足水下长时间、高精度、低成本的捷联式重力测量需求。
为了达到上述目的,本发明采用的技术方案是:根据计程仪的速度,使用扩展卡尔曼滤波,估计出激光陀螺单轴旋转捷联惯性导航系统的位置误差,然后对位置误差进行补偿,再用低通滤波器得到准确位置;以新的准确位置和计程仪的速度和深度计的水深作为捷联式重力仪的外观测量,应用捷联导航算法和扩展卡尔曼滤波,得到当地地理坐标系下的加速度计比力值;经重力各项改正后,用正反综合卡尔曼滤波,获得当地重力异常值。
对本发明所述的重力各项改正是厄特弗斯改正、正常重力场改正、空间位置改正、水平加速度改正,重力仪零漂改正。
对本发明所述的低通滤波器是正反的汉宁窗FIR低通滤波器。
有益效果:
本发明提供的一种水下捷联式重力测量数据处理方法,能够满足水下长时间、高精度、低成本的捷联式重力测量需求。
附图说明
图1是本发明一种水下捷联式重力测量数据处理方法的流程图。
具体实施方式
下面结合具体实施例对本发明作进一步地说明。
对于由激光陀螺单轴旋转捷联惯性导航系统、计程仪、深度计、捷联式重力仪组成的水下捷联式重力测量系统,水下捷联式重力仪的测量点位置是由激光陀螺单轴旋转捷联惯性导航系统/计程仪组合系统提供。
组合系统的扩展卡尔曼滤波状态方程为
Figure BDA0002569673800000021
其中,Xk是系统状态向量,Φk+1/k是状态转移矩阵,Γk+1是系统的噪声转换矩阵,WK是噪声矩阵。状态向量为
Figure BDA0002569673800000022
其中,δVE,δVN为东向和北向速度和误差,δL、δλ为经度和纬度误差,
Figure BDA0002569673800000023
分别为捷联惯导数学平台的3个误差角,δGx,δGy和δGz分别为陀螺仪X,Y,Z轴的零位漂移,δAx,δAy为加速度计X和Y轴的零位偏置,νE和νN为计程仪的东向和北向海流误差,W噪声矩阵由陀螺仪和加速度计的白噪声组成:
W=[wgx,wgy,wgz,wax,way]T (3)
状态转移矩阵:
Φk+1/k≈En+Fk·Δt (4)
其中,En是单位矩阵,Fk是组合系统误差方程矩阵,F=[fi,j],i,j=1,…14,fi,j非零项为:f1,7=nN;f1,11=c11;f1,12=c12;f1,13=c13;f2,7=-f1,6=nh;f2,7=-nE
f2,11=c21;f2,12=c22;f2,13=c23;
Figure BDA0002569673800000024
f5,7=-f7,5=-ωN,
Figure BDA0002569673800000025
f5,8=c11;f5,9=c12;f5,10=c13。
Figure BDA0002569673800000026
f6,7=-f7,6=ωE,f6,3=-UsinL;f6,8=c21;f6,9=c22;f6,10=c23;
Figure BDA0002569673800000027
f7,8=c31,f7,9=c32,f7,10=c33;
cij为姿态矩阵元素,U为地球旋转角速率,nE,nN,nh分别为东北天方向上的加速度计比力。
组合系统的扩展卡尔曼滤波观测方程为
Zk+1=Hk+1Xk+1+Vk+1 (5)
其中Zk+1是观测向量,Hk+1是观测矩阵,Vk+1是观测噪声矩阵,具体如下:
Figure BDA0002569673800000031
其中VE和VN分别是激光陀螺单轴旋转捷联惯性导航系统得到的东向和北向速度,VE,L和VN,L是计程仪输出的东向和北向速度,观测矩阵Hk+1=[hi,j]i=1,2,j=1,…14中的非零项为:h1,1=1,h1,7=-VN,h1,13=-1,h2,2=1,h2,7=VE,h2,14=-1。
通过上述扩展卡尔曼滤波,估计出激光陀螺单轴旋转捷联惯性导航系统的位置误差,对位置误差进行补偿。再利用正反的汉宁窗FIR低通滤波器,消除振荡,获得准确位置。
根据水下捷联式重力仪陀螺仪输出的角速度和加速度计输出的比力,经捷联导航算法计算,得到捷联式重力仪的位置、速度和姿态角;把上述组合系统提供的位置信息、计程仪提供的速度信息和深度计提供的水深信息作为水下捷联式重力仪的观测量,应用扩展卡尔曼滤波,计算出捷联式重力仪的姿态角和当地地理坐标系上的比力。
捷联式重力仪/计程仪/深度计组合系统的扩展卡尔曼滤波状态方程与方程(1)形式相同,但状态向量为
Figure BDA0002569673800000032
其中,δVUP为天向速度误差,δh为深度误差,δAz为加速度计Z轴的零位偏置,其它物理量解释同上。W噪声矩阵为
W=[wgx,wgy,wgz,wax,way,waz]T (8)
F=[fi,j],i,j=1,…17,fi,j非零项为:
f1,9=nN;f1,13=c11;f1,14=c12;f1,15=c13;f2,7=-f1,8=nh;f3,8=-f2,9=nE
f2,13=c21;f2,14=c22;f2,15=c23;f3,13=c31;f3,14=c32;f3,15=c33;
Figure BDA0002569673800000033
Figure BDA0002569673800000034
f6,3=1;f7,9=-f9,7=-ωN,
Figure BDA0002569673800000035
Figure BDA0002569673800000036
f8,9=-f9,8=ωE,
f8,4=-UsinL;f8,10=c21;f8,11=c22;f8,12=c23;
Figure BDA0002569673800000037
f9,10=c31,f9,11=c32,f9,12=c33;f7,10=c11;f7,11=c12;f7,12=c13。
物理量解释同上。
捷联式重力仪/计程仪/深度计组合系统的扩展卡尔曼滤波观测方程与方程(5)形式相同,但观测向量为
Figure BDA0002569673800000041
其中,VE,I和VN,I分别是捷联重力仪计算得到的东向和北向速度,VE,L和VN,L是计程仪输出的东向和北向速度,LI,λI和hI分别是捷联式重力仪计算得到的经度、纬度和深度,LLG和λLG是组合系统给出的经度和纬度,hD是深度计输出的深度。
观测矩阵Hk+1=[hi,j]i=1,…5,j=1,…17中的非零项为:h1,1=h2,2=1,h1,9=-VNh1,16=-1,h2,9=VE,h2,17=-1,h3,4=h4,5=h5,6=1。
对此当地地理坐标系中的垂向比力进行各项重力改正,如厄特弗斯改正、正常重力场改正、空间位置改正、水平加速度改正,重力仪零漂改正。
经重力改正后的垂向比力,用正反综合卡尔曼滤波,得到当地重力异常。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和等同替换,这些对本发明权利要求进行改进和等同替换后的技术方案,均落入本发明的保护范围。

Claims (3)

1.一种水下捷联式重力测量数据处理方法,其特征在于,具体步骤为:根据计程仪的速度,使用扩展卡尔曼滤波,估计出激光陀螺单轴旋转捷联惯性导航系统的位置误差,对位置误差进行补偿,再用低通滤波器得到准确位置;以新的准确位置和计程仪的速度和深度计的水深作为捷联式重力仪的外观测量,应用扩展卡尔曼滤波,计算出当地地理坐标系下的加速度计比力值;经重力各项改正后,用正反综合卡尔曼滤波,得到当地重力异常值。
2.根据权利要求1所述的一种水下捷联式重力测量数据处理方法,其特征在于,所述的重力各项改正是厄特弗斯改正、正常重力场改正、空间位置改正、水平加速度改正,重力仪零漂改正。
3.根据权利要求1所述的一种水下捷联式重力测量数据处理方法,其特征在于,所述的低通滤波器是正反的汉宁窗FIR低通滤波器。
CN202010632799.1A 2020-07-04 2020-07-04 一种水下捷联式重力测量数据处理方法 Active CN111722295B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202010632799.1A CN111722295B (zh) 2020-07-04 2020-07-04 一种水下捷联式重力测量数据处理方法
PCT/CN2020/101760 WO2022006921A1 (zh) 2020-07-04 2020-07-14 一种水下捷联式重力测量数据处理方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010632799.1A CN111722295B (zh) 2020-07-04 2020-07-04 一种水下捷联式重力测量数据处理方法

Publications (2)

Publication Number Publication Date
CN111722295A true CN111722295A (zh) 2020-09-29
CN111722295B CN111722295B (zh) 2021-04-23

Family

ID=72571533

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010632799.1A Active CN111722295B (zh) 2020-07-04 2020-07-04 一种水下捷联式重力测量数据处理方法

Country Status (2)

Country Link
CN (1) CN111722295B (zh)
WO (1) WO2022006921A1 (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112415634A (zh) * 2020-10-27 2021-02-26 青岛海洋地质研究所 基于卫星重力异常信息的动态相对重力仪零位漂移补偿方法
CN112762927A (zh) * 2020-12-18 2021-05-07 中国人民解放军战略支援部队信息工程大学 水下动态重力数据采集半实物仿真方法及系统
CN114415251A (zh) * 2022-01-14 2022-04-29 中国人民解放军国防科技大学 实时水下动态重力测量数据处理方法、装置及计算机设备
CN115371650A (zh) * 2022-08-23 2022-11-22 天津大学 一种六自由度激光标靶测量系统及其动态性能提升方法

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118519206B (zh) * 2024-07-23 2024-09-24 中国船舶集团有限公司第七〇七研究所 一种水下平台重力测量的精密补偿方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101769742A (zh) * 2010-01-19 2010-07-07 东南大学 海洋惯性重力组合导航装置
CN103389097A (zh) * 2013-08-02 2013-11-13 哈尔滨工程大学 一种基于阻尼捷联惯性导航重力异常滤波匹配的方法
US20160327394A1 (en) * 2015-05-05 2016-11-10 King Fahd University Of Petroleum And Minerals Method and apparatus for estimation of center of gravity using accelerometers
CN106405670A (zh) * 2016-10-10 2017-02-15 北京航天控制仪器研究所 一种适用于捷联式海洋重力仪的重力异常数据处理方法
CN109141436A (zh) * 2018-09-30 2019-01-04 东南大学 改进的无迹卡尔曼滤波算法在水下组合导航中的应用方法
WO2019135834A1 (en) * 2018-01-03 2019-07-11 General Electric Company Systems and methods associated with unmanned aerial vehicle targeting accuracy

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101769742A (zh) * 2010-01-19 2010-07-07 东南大学 海洋惯性重力组合导航装置
CN103389097A (zh) * 2013-08-02 2013-11-13 哈尔滨工程大学 一种基于阻尼捷联惯性导航重力异常滤波匹配的方法
US20160327394A1 (en) * 2015-05-05 2016-11-10 King Fahd University Of Petroleum And Minerals Method and apparatus for estimation of center of gravity using accelerometers
CN106405670A (zh) * 2016-10-10 2017-02-15 北京航天控制仪器研究所 一种适用于捷联式海洋重力仪的重力异常数据处理方法
WO2019135834A1 (en) * 2018-01-03 2019-07-11 General Electric Company Systems and methods associated with unmanned aerial vehicle targeting accuracy
CN109141436A (zh) * 2018-09-30 2019-01-04 东南大学 改进的无迹卡尔曼滤波算法在水下组合导航中的应用方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
QI WANG 等: "Application of gravity passive aided strapdown inertial navigation in underwater vehicles", 《SENSOR NETWORKS》 *
祝燕华 等: "SINS/计程仪/重力无源组合导航系统仿真研究", 《弹箭与制导学报》 *
罗骋 等: "捷联式重力仪在海洋测量中的应用与数据处理", 《导航定位与授时》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112415634A (zh) * 2020-10-27 2021-02-26 青岛海洋地质研究所 基于卫星重力异常信息的动态相对重力仪零位漂移补偿方法
CN112415634B (zh) * 2020-10-27 2021-12-07 青岛海洋地质研究所 基于卫星重力异常信息的动态重力仪零位漂移补偿方法
CN112762927A (zh) * 2020-12-18 2021-05-07 中国人民解放军战略支援部队信息工程大学 水下动态重力数据采集半实物仿真方法及系统
CN112762927B (zh) * 2020-12-18 2021-09-10 中国人民解放军战略支援部队信息工程大学 水下动态重力数据采集半实物仿真方法及系统
CN114415251A (zh) * 2022-01-14 2022-04-29 中国人民解放军国防科技大学 实时水下动态重力测量数据处理方法、装置及计算机设备
CN114415251B (zh) * 2022-01-14 2024-08-13 中国人民解放军国防科技大学 实时水下动态重力测量数据处理方法、装置及计算机设备
CN115371650A (zh) * 2022-08-23 2022-11-22 天津大学 一种六自由度激光标靶测量系统及其动态性能提升方法

Also Published As

Publication number Publication date
CN111722295B (zh) 2021-04-23
WO2022006921A1 (zh) 2022-01-13

Similar Documents

Publication Publication Date Title
CN111722295B (zh) 一种水下捷联式重力测量数据处理方法
CN112629538B (zh) 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法
CN110031882B (zh) 一种基于sins/dvl组合导航系统的外量测信息补偿方法
CN108051866B (zh) 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法
CN106405670B (zh) 一种适用于捷联式海洋重力仪的重力异常数据处理方法
CN103900565B (zh) 一种基于差分gps的惯导系统姿态获取方法
CN101949703B (zh) 一种捷联惯性/卫星组合导航滤波方法
CN103674030B (zh) 基于天文姿态基准保持的垂线偏差动态测量装置和方法
CN104698485B (zh) 基于bd、gps及mems的组合导航系统及导航方法
CN111102993A (zh) 一种旋转调制型捷联惯导系统晃动基座初始对准方法
CN109870173A (zh) 一种基于校验点的海底管道惯性导航系统的轨迹修正方法
CN112504275B (zh) 一种基于级联卡尔曼滤波算法的水面舰船水平姿态测量方法
CN107677292B (zh) 基于重力场模型的垂线偏差补偿方法
CN112432642B (zh) 一种重力灯塔与惯性导航融合定位方法及系统
CN109916395A (zh) 一种姿态自主冗余组合导航算法
CN109612460B (zh) 一种基于静止修正的垂线偏差测量方法
CN111812737B (zh) 水下导航与重力测量一体化系统
CN112197765A (zh) 一种实现水下机器人精细导航的方法
CN108416387B (zh) 基于gps与气压计融合数据的高度滤波方法
CN113137977A (zh) 一种sins/偏振光组合导航初始对准滤波方法
CN111141285B (zh) 一种航空重力测量装置
CN113008229A (zh) 一种基于低成本车载传感器的分布式自主组合导航方法
CN105180928B (zh) 一种基于惯性系重力特性的船载星敏感器定位方法
CN115950447A (zh) 基于磁罗盘与测速仪的水下动基座高精度对准方法及系统
CN114166226B (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