CN109709628B - 一种旋转加速度计重力梯度仪标定方法 - Google Patents
一种旋转加速度计重力梯度仪标定方法 Download PDFInfo
- Publication number
- CN109709628B CN109709628B CN201910117180.4A CN201910117180A CN109709628B CN 109709628 B CN109709628 B CN 109709628B CN 201910117180 A CN201910117180 A CN 201910117180A CN 109709628 B CN109709628 B CN 109709628B
- Authority
- CN
- China
- Prior art keywords
- gravity gradiometer
- time
- coordinate system
- angular
- indicates
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V13/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices covered by groups G01V1/00 – G01V11/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V7/00—Measuring gravitational fields or waves; Gravimetric prospecting or detecting
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V7/00—Measuring gravitational fields or waves; Gravimetric prospecting or detecting
- G01V7/02—Details
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/18—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开一种旋转加速度计重力梯度仪标定方法,通过改变旋转加速度计重力梯度仪的线运动激励、角运动激励、自梯度激励,一次标定旋转加速度计重力梯度仪的线运动误差系数、角运动误差系数、自梯度模型参数、标度系数。标定的线运动误差系数、角运动误差系数用于重力梯度仪在线运动误差补偿,标定的自梯度模型参数用于自梯度补偿。本发明提供的标定方法,不受标定场所限制,操作简单,适合程序化自标定,具有重要的工程价值。
Description
技术领域
本发明涉及一种旋转加速度计重力梯度仪标定方法,属于精密测量技术领域。
背景技术
动基座重力梯度勘探是一种低成本、高效率的重力场勘探技术。重力梯度数据广泛应用于地质分析、重力场建模、高精度导航、资源勘探等。重力梯度仪具有极其重要的民用、国防、科研价值。目前国内外在研的主流重力梯度仪主要有冷原子重力梯度仪、超导重力梯度仪、MEMS重力梯度仪、旋转加速度计重力梯度仪,其中旋转加速度计速度计重力梯度仪技术最为成熟,已经实现了商业运营,目前我国的重力梯度仪技术处于工程样机研制阶段。
动基座重力梯度勘探中,由于重力梯度仪内部的加速度计存在安装误差、加速度计一阶标度系数不匹配、电路增益不匹配、加速度计高阶非线性误差系数等,导致重力梯度仪的加速度、角速度、角加速度传递到重力梯度仪的输出,造成测量误差;重力梯度仪的加速度、角速度、角加速度激励的输出远大于万有引力梯度激励的输出,会使重力梯度仪电路饱和或损坏,因此旋转加速度计重力梯度仪需要在线补偿运动误差。重力梯度仪的在线运动误差补偿系统,需要设置线运动误差系数、角运动误差系数初值。重力梯度仪系统的组件,比如稳定平台、载体等会产生万有引力梯度,干扰重力梯度仪对目标物体万有引力梯度的测量,这部分由自身组件产生的万有引力梯度称为自梯度。在重力梯度勘探前,标定自梯度模型参数,在勘探中,记录重力梯度仪的姿态,利用自梯度模型,计算自梯度,并补偿自梯度。重力梯度仪的运动误差系数、标度系数、自梯度模型参数,是重力梯度仪需要标定的参数。
发明内容
本发明的目的是为了解决上述问题,提供一种旋转加速度计重力梯度仪标定方法,该方法基于旋转加速度计重力梯度仪解析模型、自梯度模型,在标定时,同时改变重力梯度仪经历的线运动、角运动、自梯度激励,记录重力梯度仪的输出,一次快速标定重力梯度仪运动误差系数、标度系数、自梯度模型参数。标定的重力梯度仪运动误差系数,用于设置旋转加速度计重力梯度仪在线运动误差补偿系统中的参数,标定的自梯度模型参数,用于重力梯度仪自梯度补偿。
为达到上述目的,本发明采用的方式是,提供一种旋转加速度计重力梯度仪标定方法,包括以下步骤:
(1)对旋转加速度计重力梯度仪施加线运动、角运动,同时不断改变重力梯度仪的姿态,记录重力梯度仪经历的线运动(ax,ay,az)、角运动(ωx,ωy,ωz,ωax,ωay,ωaz)、姿态(θx,θy,θz)、重力梯度仪的输出(Gout)作为标定的数据;用于标定的数据起始时间为t1,结束时间为tp,重力梯度仪的线运动数据为:
式中ax表示重力梯度仪测量坐标系x方向的加速度数据,ax(t1)表示t1时刻重力梯度仪测量坐标系x方向的加速度;ax(t)表示t时刻重力梯度仪测量坐标系x方向的加速度;ax(t2)表示t2时刻重力梯度仪测量坐标系x方向的加速度;ay表示重力梯度仪测量坐标系y方向的加速度数据,ay(t1)表示t1时刻重力梯度仪测量坐标系y方向的加速度;ay(t)表示t时刻重力梯度仪测量坐标系y方向的加速度;ay(t2)表示t2时刻重力梯度仪测量坐标系y方向的加速度;az表示重力梯度仪测量坐标系z方向的加速度数据,az(t1)表示t1时刻重力梯度仪测量坐标系z方向的加速度;az(t)表示t时刻重力梯度仪测量坐标系z方向的加速度;az(t2)表示t2时刻重力梯度仪测量坐标系z方向的加速度;式中[·]T表示转置运算;重力梯度仪角运动数据为:
式中ωx表示重力梯度仪测量坐标系x方向的角速度数据,ωx(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角速度,ωx(t)表示t时刻重力梯度仪测量坐标系x方向的角速度,ωx(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角速度;ωy表示重力梯度仪测量坐标系y方向的角速度数据,ωy(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角速度,ωy(t)表示t时刻重力梯度仪测量坐标系y方向的角速度,ωy(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角速度;
ωz表示重力梯度仪测量坐标系z方向的角速度数据,ωz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角速度,ωz(t)表示t时刻重力梯度仪测量坐标系z方向的角速度,ωz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角速度;
ωax表示重力梯度仪测量坐标系x方向的角加速度数据,ωax(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角加速度,ωax(t)表示t时刻重力梯度仪测量坐标系x方向的角加速度,ωax(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角加速度;ωay表示重力梯度仪测量坐标系y方向的角加速度数据,ωay(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角加速度,ωay(t)表示t时刻重力梯度仪测量坐标系y方向的角加速度,ωay(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角加速度;ωaz表示重力梯度仪测量坐标系z方向的角加速度数据,ωaz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角加速度,ωaz(t)表示t时刻重力梯度仪测量坐标系z方向的角加速度,ωaz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角加速度;重力梯度仪的姿态数据为:
式中θx表示绕x轴旋转的姿态角数据,θx(t1)表示起始时刻t1,绕x轴旋转的姿态角,θx(t)表示t时刻绕x轴旋转的姿态角,θx(tp)表示结束时刻tp,绕x轴旋转的姿态角;θy表示绕y轴旋转的姿态角数据,θy(t1)表示起始时刻t1,绕y轴旋转的姿态角,θy(t)表示t时刻绕y轴旋转的姿态角,θy(tp)表示结束时刻tp,绕y轴旋转的姿态角;θz表示绕z轴旋转的姿态角数据,θz(t1)表示起始时刻t1,绕z轴旋转的姿态角,θz(t)表示t时刻绕z轴旋转的姿态角,θz(tp)表示结束时刻tp,绕z轴旋转的姿态角;
重力梯度仪的输出数据为:
Gout=[Gout(t1),…,Gout(t),…,Gout(tp)]
式中Gout是重力梯度仪的输出数据,Gout(t1)表示起始时刻t1,重力梯度仪的输出,Gout(t)表示t时刻重力梯度仪的输出,Gout(tp)表示tp时刻重力梯度仪的输出;
(2)根据下述方式,标定旋转加速度计重力梯度仪的线运动误差系数向量Cm、角运动误差系数向量CA、标度系数kggi;
(2-1).根据下式,计算所有时刻的线运动向量、角运动向量:
式中Lm(t)表示t时刻的线运动向量,La(t)表示t时刻的角运动向量,ax(t),ay(t),az(t)表示t时刻的线运动数据,ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t)表示t时刻的角运动数据,Ω表示旋转加速度计重力梯度仪旋转圆盘角频率;
(2-2).将所有时刻的线运动向量、角运动向量,代入下式计算运动矩阵L:
式中Lm(t1)表示起始时刻t1的线运动向量,Lm(t)表示t时刻的线运动向量,Lm(tp)表示结束时刻tp的线运动向量;La(t1)表示起始时刻t1的角运动向量,La(t)表示t时刻的角运动向量,La(tp)表示结束时刻tp的角运动向量;
(2-3).根据下式,标定线运动误差系数向量Cm,角运动误差系数向量CA,Cm是1×10向量,CA是1×8向量:
[Cm,CA]=Gout·L+
式中Gout是旋转加速度计重力梯度仪的输出,L+表示L矩阵的加号逆;重力梯度仪的标度系数kggi等于角运动误差系数向量CA的第1个元素,也就是kggi=CA(1);
(3)根据下述方式,标定自梯度模型参数:
(3-1).根据下式,计算所有时刻的调制向量
Cref(t)=[sin2Ωt,cos2Ωt]
Cref(t)表示t时刻的调制向量;
(3-2).将姿态数据代入下式,计算所有时刻的姿态特征参数:
式中,c,c2分别表示cos(),cos2(),s,s2分别表示sin(),sin2();θx(t),θy(t),θz(t)表示t时刻的姿态,a1,1(t),…,a1,18(t),a21(t),…,a2,18(t)是t时刻的姿态特征参数;
(3-3).将计算的姿态特征参数,代入下式,计算所有时刻的姿态特征矩阵:
式中Aattu(t)表示时刻t的姿态特征矩阵,Aattu(t)是2×18矩阵;
(3-4).根据下式,标定重力梯度仪自梯度模型参数:
式中P表示标定的自梯度模型参数,Cm是步骤2)中标定的线运动误差系数向量,CA是步骤2)中标定的角运动误差系数向量,CA(1)是角运动误差系数向量的第1个元素;Lm(t1)是起始时刻t1的线运动向量,Lm(t)是t时刻的线运动向量,Lm(tp)是结束时刻tp的线运动向量;La(t)是t时刻的角运动向量,La(t1)是起始时刻t1的角运动向量,La(tp)是结束时刻tp的角运动向量;Cref(t)是t时刻的调制向量,Cref(t1)是起始时刻t1的调制向量,Cref(tp)是结束时刻tp的调制向量;Aattu(t)是t时刻的姿态特征矩阵,Aattu(t1)是起始时刻t1的姿态特征矩阵,Aattu(tp)是结束时刻tp的姿态特征矩阵。
有益效果:
本发明提供一种通过改变重力梯度仪的线运动激励、角运动激励、自梯度激励,一次标定重力梯度仪的标度系数、运动误差系数、自梯度模型参数的方法,该标定方法不需要外部检测质量,利用重力梯度仪系统本身、借助计算机程序可实现自标定,不受标定场所限制,非常适合工程应用。
附图说明
图1重力梯度仪角运动、线运动传感器安装示意图。
图2旋转加速度计重力梯度仪标定流程。
具体实施方式
下面结合实施例和说明书附图对本发明作进一步地说明。
如图1所示,A1,A2,A3,A4是旋转加速度计重力梯度仪上安装的四只加速度计,是万有引力梯度敏感元件;重力梯度仪测量坐标系的原点位于圆盘中心,xm是重力梯度仪测量坐标系的x轴,ym是重力梯度仪测量坐标系的y轴,zm是重力梯度仪测量坐标系的z轴;在重力梯度仪旋转圆盘中心点安装一只三轴加速度计,用于记录重力梯度仪经历的线运动;在重力梯度仪测量坐标系的三个坐标轴分别安装陀螺仪,用于记录重力梯度仪经历的角运动(角速度,角加速度)。
如图2所示,一种旋转加速度计重力梯度仪标定方法,包括以下步骤:
(1)对旋转加速度计重力梯度仪施加线运动、角运动,同时不断改变重力梯度仪的姿态,记录重力梯度仪经历的线运动(ax,ay,az)、角运动(ωx,ωy,ωz,ωax,ωay,ωaz)、姿态(θx,θy,θz)、重力梯度仪的输出(Gout)作为标定的数据;用于标定的数据起始时间为t1,结束时间为tp,重力梯度仪的线运动数据为:
式中ax表示重力梯度仪测量坐标系x方向的加速度数据,ax(t1)表示t1时刻重力梯度仪测量坐标系x方向的加速度;ax(t)表示t时刻重力梯度仪测量坐标系x方向的加速度;ax(t2)表示t2时刻重力梯度仪测量坐标系x方向的加速度;ay表示重力梯度仪测量坐标系y方向的加速度数据,ay(t1)表示t1时刻重力梯度仪测量坐标系y方向的加速度;ay(t)表示t时刻重力梯度仪测量坐标系y方向的加速度;ay(t2)表示t2时刻重力梯度仪测量坐标系y方向的加速度;az表示重力梯度仪测量坐标系z方向的加速度数据,az(t1)表示t1时刻重力梯度仪测量坐标系z方向的加速度;az(t)表示t时刻重力梯度仪测量坐标系z方向的加速度;az(t2)表示t2时刻重力梯度仪测量坐标系z方向的加速度;式中[·]T表示转置运算;重力梯度仪角运动数据为:
式中ωx表示重力梯度仪测量坐标系x方向的角速度数据,ωx(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角速度,ωx(t)表示t时刻重力梯度仪测量坐标系x方向的角速度,ωx(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角速度;
ωy表示重力梯度仪测量坐标系y方向的角速度数据,ωy(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角速度,ωy(t)表示t时刻重力梯度仪测量坐标系y方向的角速度,ωy(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角速度;
ωz表示重力梯度仪测量坐标系z方向的角速度数据,ωz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角速度,ωz(t)表示t时刻重力梯度仪测量坐标系z方向的角速度,ωz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角速度;
ωax表示重力梯度仪测量坐标系x方向的角加速度数据,ωax(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角加速度,ωax(t)表示t时刻重力梯度仪测量坐标系x方向的角加速度,ωax(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角加速度;ωay表示重力梯度仪测量坐标系y方向的角加速度数据,ωay(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角加速度,ωay(t)表示t时刻重力梯度仪测量坐标系y方向的角加速度,ωay(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角加速度;ωaz表示重力梯度仪测量坐标系z方向的角加速度数据,ωaz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角加速度,ωaz(t)表示t时刻重力梯度仪测量坐标系z方向的角加速度,ωaz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角加速度;重力梯度仪的姿态数据为:
式中θx表示绕x轴旋转的姿态角数据,θx(t1)表示起始时刻t1,绕x轴旋转的姿态角,θx(t)表示t时刻绕x轴旋转的姿态角,θx(tp)表示结束时刻tp,绕x轴旋转的姿态角;θy表示绕y轴旋转的姿态角数据,θy(t1)表示起始时刻t1,绕y轴旋转的姿态角,θy(t)表示t时刻绕y轴旋转的姿态角,θy(tp)表示结束时刻tp,绕y轴旋转的姿态角;θz表示绕z轴旋转的姿态角数据,θz(t1)表示起始时刻t1,绕z轴旋转的姿态角,θz(t)表示t时刻绕z轴旋转的姿态角,θz(tp)表示结束时刻tp,绕z轴旋转的姿态角;
重力梯度仪的输出数据为:
Gout=[Gout(t1),…,Gout(t),…,Gout(tp)]
式中Gout是重力梯度仪的输出数据,Gout(t1)表示起始时刻t1,重力梯度仪的输出,Gout(t)表示t时刻重力梯度仪的输出,Gout(tp)表示tp时刻重力梯度仪的输出;
(2)根据下述方式,标定旋转加速度计重力梯度仪的线运动误差系数向量Cm、角运动误差系数向量CA、标度系数kggi;
(2-1).根据下式,计算所有时刻的线运动向量、角运动向量:
式中Lm(t)表示t时刻的线运动向量,La(t)表示t时刻的角运动向量,ax(t),ay(t),az(t)表示t时刻的线运动数据,ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t)表示t时刻的角运动数据,Ω表示旋转加速度计重力梯度仪旋转圆盘角频率;
(2-2).将所有时刻的线运动向量、角运动向量,代入下式计算运动矩阵L:
式中Lm(t1)表示起始时刻t1的线运动向量,Lm(t)表示t时刻的线运动向量,Lm(tp)表示结束时刻tp的线运动向量;La(t1)表示起始时刻t1的角运动向量,La(t)表示t时刻的角运动向量,La(tp)表示结束时刻tp的角运动向量;
(2-3).根据下式,标定线运动误差系数向量Cm,角运动误差系数向量CA,Cm是1×10向量,CA是1×8向量:
[Cm,CA]=Gout·L+
式中Gout是旋转加速度计重力梯度仪的输出,L+表示L矩阵的加号逆;重力梯度仪的标度系数kggi等于角运动误差系数向量CA的第1个元素,也就是kggi=CA(1);
(3)根据下述方式,标定自梯度模型参数:
(3-1).根据下式,计算所有时刻的调制向量
Cref(t)=[sin2Ωt,cos2Ωt]
Cref(t)表示t时刻的调制向量;
(3-2).将姿态数据代入下式,计算所有时刻的姿态特征参数:
式中,c,c2分别表示cos(),cos2(),s,s2分别表示sin(),sin2();θx(t),θy(t),θz(t)表示t时刻的姿态,a1,1(t),…,a1,18(t),a21(t),…,a2,18(t)是t时刻的姿态特征参数;
(3-3).将计算的姿态特征参数,代入下式,计算所有时刻的姿态特征矩阵:
式中Aattu(t)表示时刻t的姿态特征矩阵,Aattu(t)是2×18矩阵;
(3-4).根据下式,标定重力梯度仪自梯度模型参数:
式中P表示标定的自梯度模型参数,Cm是步骤2)中标定的线运动误差系数向量,CA是步骤2)中标定的角运动误差系数向量,CA(1)是角运动误差系数向量的第1个元素;Lm(t1)是起始时刻t1的线运动向量,Lm(t)是t时刻的线运动向量,Lm(tp)是结束时刻tp的线运动向量;La(t)是t时刻的角运动向量,La(t1)是起始时刻t1的角运动向量,La(tp)是结束时刻tp的角运动向量;Cref(t)是t时刻的调制向量,Cref(t1)是起始时刻t1的调制向量,Cref(tp)是结束时刻tp的调制向量;Aattu(t)是t时刻的姿态特征矩阵,Aattu(t1)是起始时刻t1的姿态特征矩阵,Aattu(tp)是结束时刻tp的姿态特征矩阵
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术上述实施例仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和等同替换,这些对本发明权利要求进行改进和等同替换后的技术方案,均落入本发明的保护范围。
Claims (1)
1.一种旋转加速度计重力梯度仪标定方法,其特征在于,该方法包括以下步骤:
(1)对旋转加速度计重力梯度仪施加线运动、角运动,同时不断改变重力梯度仪的姿态,记录重力梯度仪经历的线运动(ax,ay,az)、角运动(ωx,ωy,ωz,ωax,ωay,ωaz)、姿态(θx,θy,θz)、重力梯度仪的输出(Gout)作为标定的数据;用于标定的数据起始时间为t1,结束时间为tp,重力梯度仪的线运动数据为:
式中ax表示重力梯度仪测量坐标系x方向的加速度数据,ax(t1)表示t1时刻重力梯度仪测量坐标系x方向的加速度;ax(t)表示t时刻重力梯度仪测量坐标系x方向的加速度;ay表示重力梯度仪测量坐标系y方向的加速度数据,ay(t1)表示t1时刻重力梯度仪测量坐标系y方向的加速度;ay(t)表示t时刻重力梯度仪测量坐标系y方向的加速度;az表示重力梯度仪测量坐标系z方向的加速度数据,az(t1)表示t1时刻重力梯度仪测量坐标系z方向的加速度;az(t)表示t时刻重力梯度仪测量坐标系z方向的加速度;式中[·]T表示转置运算;重力梯度仪角运动数据为:
式中ωx表示重力梯度仪测量坐标系x方向的角速度数据,ωx(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角速度,ωx(t)表示t时刻重力梯度仪测量坐标系x方向的角速度,ωx(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角速度;
ωy表示重力梯度仪测量坐标系y方向的角速度数据,ωy(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角速度,ωy(t)表示t时刻重力梯度仪测量坐标系y方向的角速度,ωy(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角速度;
ωz表示重力梯度仪测量坐标系z方向的角速度数据,ωz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角速度,ωz(t)表示t时刻重力梯度仪测量坐标系z方向的角速度,ωz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角速度;
ωax表示重力梯度仪测量坐标系x方向的角加速度数据,ωax(t1)表示起始时刻t1,重力梯度仪测量坐标系x方向的角加速度,ωax(t)表示t时刻重力梯度仪测量坐标系x方向的角加速度,ωax(tp)表示结束时刻tp,重力梯度仪测量坐标系x方向的角加速度;ωay表示重力梯度仪测量坐标系y方向的角加速度数据,ωay(t1)表示起始时刻t1,重力梯度仪测量坐标系y方向的角加速度,ωay(t)表示t时刻重力梯度仪测量坐标系y方向的角加速度,ωay(tp)表示结束时刻tp,重力梯度仪测量坐标系y方向的角加速度;ωaz表示重力梯度仪测量坐标系z方向的角加速度数据,ωaz(t1)表示起始时刻t1,重力梯度仪测量坐标系z方向的角加速度,ωaz(t)表示t时刻重力梯度仪测量坐标系z方向的角加速度,ωaz(tp)表示结束时刻tp,重力梯度仪测量坐标系z方向的角加速度;重力梯度仪的姿态数据为:
式中θx表示绕x轴旋转的姿态角数据,θx(t1)表示起始时刻t1,绕x轴旋转的姿态角,θx(t)表示t时刻绕x轴旋转的姿态角,θx(tp)表示结束时刻tp,绕x轴旋转的姿态角;θy表示绕y轴旋转的姿态角数据,θy(t1)表示起始时刻t1,绕y轴旋转的姿态角,θy(t)表示t时刻绕y轴旋转的姿态角,θy(tp)表示结束时刻tp,绕y轴旋转的姿态角;θz表示绕z轴旋转的姿态角数据,θz(t1)表示起始时刻t1,绕z轴旋转的姿态角,θz(t)表示t时刻绕z轴旋转的姿态角,θz(tp)表示结束时刻tp,绕z轴旋转的姿态角;
重力梯度仪的输出数据为:
Gout=[Gout(t1),…,Gout(t),…,Gout(tp)]
式中Gout是重力梯度仪的输出数据,Gout(t1)表示起始时刻t1,重力梯度仪的输出,Gout(t)表示t时刻重力梯度仪的输出,Gout(tp)表示tp时刻重力梯度仪的输出;
(2)根据下述方式,标定旋转加速度计重力梯度仪的线运动误差系数向量Cm、角运动误差系数向量CA、标度系数kggi,具体步骤如下:
(2-1).根据下式,计算所有时刻的线运动向量、角运动向量:
式中Lm(t)表示t时刻的线运动向量,La(t)表示t时刻的角运动向量,ax(t),ay(t),az(t)表示t时刻的线运动数据,ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t)表示t时刻的角运动数据,Ω表示旋转加速度计重力梯度仪旋转圆盘角频率;
(2-2).将所有时刻的线运动向量、角运动向量,代入下式计算运动矩阵L:
式中Lm(t1)表示起始时刻t1的线运动向量,Lm(t)表示t时刻的线运动向量,Lm(tp)表示结束时刻tp的线运动向量;La(t1)表示起始时刻t1的角运动向量,La(t)表示t时刻的角运动向量,La(tp)表示结束时刻tp的角运动向量;
(2-3).根据下式,标定线运动误差系数向量Cm,角运动误差系数向量CA,Cm是1×10向量,CA是1×8向量:
[Cm,CA]=Gout·L+
式中Gout是旋转加速度计重力梯度仪的输出,L+表示L矩阵的加号逆;重力梯度仪的标度系数kggi等于角运动误差系数向量CA的第1个元素,也就是kggi=CA(1);
(3)标定自梯度模型参数,具体步骤为:
(3-1).根据下式,计算所有时刻的调制向量
Cref(t)=[sin2Ωt,cos2Ωt]
Cref(t)表示t时刻的调制向量;
(3-2).将姿态数据代入下式,计算所有时刻的姿态特征参数:
式中,c,c2分别表示cos(),cos2(),s,s2分别表示sin(),sin2();θx(t),θy(t),θz(t)表示t时刻的姿态,a1,1(t),…,a1,18(t),a21(t),…,a2,18(t)是t时刻的姿态特征参数;
(3-3).将计算的姿态特征参数,代入下式,计算所有时刻的姿态特征矩阵:
式中Aattu(t)表示时刻t的姿态特征矩阵,Aattu(t)是2×18矩阵;
(3-4).根据下式,标定重力梯度仪自梯度模型参数:
式中P表示标定的自梯度模型参数,Cm是步骤2)中标定的线运动误差系数向量,CA是步骤2)中标定的角运动误差系数向量,CA(1)是角运动误差系数向量的第1个元素;Lm(t1)是起始时刻t1的线运动向量,Lm(t)是t时刻的线运动向量,Lm(tp)是结束时刻tp的线运动向量;La(t)是t时刻的角运动向量,La(t1)是起始时刻t1的角运动向量,La(tp)是结束时刻tp的角运动向量;Cref(t)是t时刻的调制向量,Cref(t1)是起始时刻t1的调制向量,Cref(tp)是结束时刻tp的调制向量;Aattu(t)是t时刻的姿态特征矩阵,Aattu(t1)是起始时刻t1的姿态特征矩阵,Aattu(tp)是结束时刻tp的姿态特征矩阵。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910117180.4A CN109709628B (zh) | 2019-02-15 | 2019-02-15 | 一种旋转加速度计重力梯度仪标定方法 |
PCT/CN2019/089236 WO2020164206A1 (zh) | 2019-02-15 | 2019-05-30 | 一种旋转加速度计重力梯度仪标定方法 |
US17/421,383 US11372130B2 (en) | 2019-02-15 | 2019-05-30 | Calibration method for rotating accelerometer gravity gradiometer |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910117180.4A CN109709628B (zh) | 2019-02-15 | 2019-02-15 | 一种旋转加速度计重力梯度仪标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109709628A CN109709628A (zh) | 2019-05-03 |
CN109709628B true CN109709628B (zh) | 2020-08-14 |
Family
ID=66263654
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910117180.4A Active CN109709628B (zh) | 2019-02-15 | 2019-02-15 | 一种旋转加速度计重力梯度仪标定方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11372130B2 (zh) |
CN (1) | CN109709628B (zh) |
WO (1) | WO2020164206A1 (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109709628B (zh) | 2019-02-15 | 2020-08-14 | 东南大学 | 一种旋转加速度计重力梯度仪标定方法 |
CN110068876B (zh) * | 2019-05-30 | 2021-01-26 | 中国船舶重工集团公司第七0七研究所 | 基于载体自振动航空重力梯度仪运动误差补偿方法 |
CN112363247B (zh) * | 2020-10-27 | 2021-09-07 | 华中科技大学 | 一种重力梯度仪运动误差事后补偿方法 |
CN113267821B (zh) * | 2021-04-30 | 2022-05-03 | 北京大学 | 一种基于角运动的重力梯度测量方法及系统 |
CN114089441B (zh) * | 2021-11-26 | 2022-08-30 | 华中科技大学 | 一种重力梯度仪测量系统数值仿真方法 |
CN115755206A (zh) * | 2022-11-09 | 2023-03-07 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种陆地重力仪数字调平补偿系统及方法 |
CN117110649A (zh) * | 2023-08-02 | 2023-11-24 | 中国科学院自动化研究所 | 一种运动数据的质量增强方法、装置和系统 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5339684A (en) * | 1991-12-10 | 1994-08-23 | Textron Inc. | Gravity aided inertial navigation system |
US6918186B2 (en) * | 2003-08-01 | 2005-07-19 | The Charles Stark Draper Laboratory, Inc. | Compact navigation system and method |
US20080257038A1 (en) * | 2005-10-06 | 2008-10-23 | Technological Resources Pty. Limited | Gravity Gradiometer |
US20110310698A1 (en) * | 2010-06-21 | 2011-12-22 | Sercel, Inc. | Dual Axis Geophones For Pressure/Velocity Sensing Streamers Forming a Triple Component Streamer |
JP2013061158A (ja) * | 2011-09-12 | 2013-04-04 | Yoichi Takagi | 地球の重力測定装置と方法 |
CN105717553B (zh) * | 2016-01-29 | 2018-01-16 | 东南大学 | 一种旋转加速度计重力梯度仪标定方法 |
CN107576992B (zh) * | 2017-09-04 | 2019-02-22 | 东南大学 | 一种重力梯度仪自标定方法及离心梯度补偿方法 |
CN107870371B (zh) * | 2017-12-05 | 2019-04-30 | 东南大学 | 一种动基座重力梯度仪自梯度补偿方法 |
CN108931824B (zh) * | 2018-04-27 | 2020-02-18 | 东南大学 | 一种动基座旋转加速度计重力梯度仪误差增益系数标定方法 |
CN109001841B (zh) * | 2018-05-25 | 2020-02-18 | 东南大学 | 一种基于地球自转角速度的重力梯度仪标定方法 |
CN109085654B (zh) * | 2018-06-11 | 2020-01-07 | 东南大学 | 一种旋转加速度计重力梯度仪数字建模仿真方法 |
CN108873093B (zh) * | 2018-07-12 | 2019-11-05 | 临沂大学 | 一种航空重力梯度仪自梯度补偿方法 |
CN109212620B (zh) * | 2018-08-27 | 2020-01-07 | 东南大学 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
CN109766812B (zh) * | 2018-12-31 | 2021-03-09 | 东南大学 | 一种旋转加速度计重力梯度仪运动误差事后补偿方法 |
CN109709628B (zh) | 2019-02-15 | 2020-08-14 | 东南大学 | 一种旋转加速度计重力梯度仪标定方法 |
-
2019
- 2019-02-15 CN CN201910117180.4A patent/CN109709628B/zh active Active
- 2019-05-30 US US17/421,383 patent/US11372130B2/en active Active
- 2019-05-30 WO PCT/CN2019/089236 patent/WO2020164206A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
US11372130B2 (en) | 2022-06-28 |
US20220091299A1 (en) | 2022-03-24 |
CN109709628A (zh) | 2019-05-03 |
WO2020164206A1 (zh) | 2020-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109709628B (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN204831330U (zh) | 一种三轴转台的姿态传感器测试系统 | |
CN109766812B (zh) | 一种旋转加速度计重力梯度仪运动误差事后补偿方法 | |
CN111679097B (zh) | 一种高精度的加速度计温度补偿方法 | |
CN113916256B (zh) | 三轴mems陀螺组合惯性测量单元标定方法 | |
CN106840100A (zh) | 一种数字式倾角传感器及测量方法 | |
CN100491204C (zh) | 一种利用定轨数据标定加速度计的方法 | |
CN113885098A (zh) | 一种重力敏感器低频频率响应误差在线建模及补偿方法 | |
CN113916257B (zh) | 三轴mems加计组合惯性测量单元标定方法 | |
CN112254717B (zh) | 一种基于冷原子干涉陀螺仪的惯性导航装置及方法 | |
CN112683303B (zh) | 一种惯性测量单元陀螺位置补偿方法 | |
CN109085654B (zh) | 一种旋转加速度计重力梯度仪数字建模仿真方法 | |
CN109871658A (zh) | 用于导弹弹头转动惯量和惯性积测量的多姿态最优估计方法 | |
CN109001841B (zh) | 一种基于地球自转角速度的重力梯度仪标定方法 | |
CN114509580A (zh) | 一种小量程加速度计高精度温度建模方法 | |
CN111896773B (zh) | 一种三轴石英挠性加速度计总成及其测量方法 | |
CN110568387B (zh) | 一种基于磁梯度张量的航天器磁矩测试方法 | |
Zhang et al. | Implementation and complexity analysis of orientation estimation algorithms for human body motion tracking using low-cost sensors | |
Zhao et al. | A Study on Alignment of analytic Space Stable Inertial Navigation System | |
Oberndorfer et al. | GOCE closed-loop simulation | |
CN113970344B (zh) | 一种惯导系统的陀螺和加速度计刻度系数非对称性误差标定方法 | |
CN112325902B (zh) | 重力仪惯性组件系统级在线标定参考坐标系建立方法 | |
CN115950456B (zh) | 一种基于陀螺仪角速率测量的加速度计标定方法 | |
CN114415262B (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 |