CN109212620B - 动基座旋转加速度计重力梯度仪误差补偿装置及方法 - Google Patents
动基座旋转加速度计重力梯度仪误差补偿装置及方法 Download PDFInfo
- Publication number
- CN109212620B CN109212620B CN201810985818.1A CN201810985818A CN109212620B CN 109212620 B CN109212620 B CN 109212620B CN 201810985818 A CN201810985818 A CN 201810985818A CN 109212620 B CN109212620 B CN 109212620B
- Authority
- CN
- China
- Prior art keywords
- motion error
- gravity gradiometer
- transfer coefficient
- module
- angular
- 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
- 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
- G01V13/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices covered by groups G01V1/00 – G01V11/00
Landscapes
- Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- General Physics & Mathematics (AREA)
- Geophysics (AREA)
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
- Investigating Strength Of Materials By Application Of Mechanical Stress (AREA)
Abstract
本发明公开一种动基座旋转加速度计重力梯度仪误差补偿装置及方法,根据检测的重力梯度仪的角运动,线运动,姿态角,基于重力梯度仪解析模型,自梯度模型,计算重力梯度仪的角运动误差,线运动误差,自梯度,并将角运动误差,线运动误差,自梯度进行正交幅值调制,对重力梯度仪解调前的信号进行补偿。本发明不仅补偿了重力梯度仪输出信号中的角运动误差,线运动误差,自梯度,还解决了重力梯度仪角运动,线运动,自梯度引起的重力梯度仪前端调理电路过电压损坏,过电压饱和的问题。重力梯度仪补偿后的信号用于反馈调节线运动误差传递系数,角运动误差传递系数,加速度计标度系数,能够抵消温度、磁场等环境因素对重力梯度仪误差传递系数的影响。
Description
技术领域
本发明涉及一种动基座旋转加速度计重力梯度仪误差补偿装置及方法,属于精密测量技术领域。
背景技术
动基座重力梯度勘探是一种低成本、高效率的重力梯度勘探方法;是目前世界上最先进的重力场勘探方式。重力梯度数据广泛应用于地质分析、重力场建模、高精度导航、资源勘探等。重力梯度仪具有极其重要的国防、民用价值。目前国内外在研的重力梯度仪主要有冷原子重力梯度仪、超导重力梯度仪、MEMS重力梯度仪等。国外已经投入商业应用的重力梯度仪主要有旋转加速度计重力梯度仪及旋转超导加速度计重力梯度仪。我国的重力梯度仪样机正处于研制中。
在动基座重力梯度勘探时,由于重力梯度仪内部的加速度计存在安装误差、加速度计一阶、高阶标度系数不匹配、电路增益不匹配等,导致重力梯度仪的加速度,角速度,角加速度传递到重力梯度仪的输出,造成测量误差。同时重力梯度仪线运动、自梯度、角运动会引起重力梯度仪前端信号调理电路过电压饱和或损坏。本发明提供一种能够实时补偿重力梯度仪线运动误差、角运动误差、自梯度的装置及方法,目前没有关于重力梯度仪线运动误差、角运动误差实时补偿装置及技术的公开的报道。
发明内容
技术问题:本发明提供一种能够反馈补偿重力梯度仪的线运动、角运动、自梯度引起的输出测量误差的动基座旋转加速度计重力梯度仪误差补偿装置,既能抑制温度、电磁场等环境因素对误差传递系数的影响,同时还能避免重力梯度仪的加速度、角速度、角加速度引起的重力梯度仪前端信号调理电路过电压饱和及过电压损坏。本发明同时提供一种具有以上效果、解决了以上问题的动基座旋转加速度计重力梯度仪误差补偿方法。
技术方案:本发明的动基座旋转加速度计重力梯度仪误差补偿装置,包括:
用于产生正交幅度调制载波的参考信号产生模块;
用于实时产生自梯度补偿信号的自梯度补偿信号产生模块;
用于实时产生重力梯度仪角运动误差补偿信号及检测重力梯度仪离心梯度的角运动误差补偿信号产生模块;
用于实时微调角运动误差传递系数的角运动误差传递系数处理模块;
用于实时产生重力梯度仪线运动误差补偿信号的线运动误差补偿信号产生模块;
用于实时微调线运动误差传递系数的线运动误差传递系数处理模块;
用于对安装在旋转圆盘上的加速度计的输出信号求和、求差运算的重力梯度仪加速度计信号处理模块;
用于实时调节加速度计标度系数的加速度计标度系数调节模块;
用于对含有角运动误差,线运动误差,自梯度的重力梯度信号进行补偿的补偿运算模块;
用于从补偿后的重力梯度仪信号解调输出重力梯度信号的重力梯度信号恢复模块;
所述参考信号产生模块的输出连接到自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块的输入;所述自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块、重力梯度仪加速度计信号处理模块的输出连接到补偿运算模块的输入;所述补偿运算模块的输出连接到加速度计标度系数调节模块、角运动误差传递系数处理模块、线运动误差传递系数处理模块、重力梯度信号恢复模块的输入;所述线运动误差传递系数处理模块的输出连接到线运动误差补偿信号产生模块的输入;所述角运动误差传递系数处理模块的输出连接到角运动误差补偿信号产生模块的输入;所述加速度计标度系数调节模块的输出连接到重力梯度仪加速度计信号处理模块的输入。
进一步的,本发明装置中,所述参考信号产生模块包括重力梯度仪旋转圆盘轴编码器和信号发生器;所述重力梯度仪旋转圆盘轴编码器检测重力梯度仪圆盘旋转的相位角φt,所述信号发生器根据相位角φt,产生正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt;
进一步的,本发明装置中,所述角运动误差传递系数处理模块包括角运动误差传递系数初值设置模块和角运动误差传递系数调节模块,所述角运动误差传递系数初值设置模块用于设置角运动误差传递系数初值:所述角运动误差传递系数调节模块根据反馈的补偿后的重力梯度仪信号产生调节量,微调角运动误差传递系数;角运动误差传递系数处理模块具有两种工作模式,调节模式和非调节模式,当工作在调节模式时,实时调节角运动误差传递系数;当工作在非调节模式时,角运动误差传递系保持不变。
进一步的,本发明装置中,所述的角运动误差补偿信号产生模块包括角运动误差传递系数输入模块、角运动检测模块、参考信号输入模块、角运动补偿信号产生模块、离心梯度检测模块;
所述角运动误差传递系数输入模块用于输入角运动误差传递系数;所述参考信号输入模块用于输入正交幅度调制载波;所述角运动检测模块包括角速率传感器和低通滤波器,用于检测重力梯度仪的角运动;所述角速率传感器安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的角速度ωx,ωy,ωz及角加速度ωax,ωay,ωaz;所述低通滤波器则滤除角速度、角加速度信号中的高频噪声;所述角运动补偿信号产生模块根据正交幅度调制载波、角运动误差传递系数、角加速度、角速度产生角运动误差补偿信号;所述离心梯度检测模块有两种工作模式,标定模式和非标定模式,在标定模式下,离心梯度检测单元输出检测的离心梯度,在非标定模式下,离心梯度检测单元无输出。
进一步的,本发明装置中,所述的角运动误差补偿信号产生模块具有三种工作模式,非补偿模式,正常模式,标定模式;非补偿模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
CA(t)=0;
在正常模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
在标定模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
式中sin2φt,cos2φt,sinφt,cosφt为t时刻输入角运动误差补偿信号产生模块的正交幅度调制载波;表示t时刻输入角运动误差补偿信号产生模块的角运动误差传递系数;ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t)表示t时刻输入角运动误差补偿信号产生模块的角运动信号。
进一步的,本发明装置中,所述线运动误差传递系数处理模块包括线运动误差传递系数初值设置模块和线运动误差传递系数调节模块,所述线运动误差传递系数初值设置模块用以设置线运动误差传递系数初值:所述线运动误差传递差系数调节模块根据反馈的补偿后的重力梯度仪信号产生调节量和微调线运动误差传递系数;线运动误差传递系数处理模块具有两种工作模式,调节模式和非调节模式,当工作在调节模式时,实时调节线运动误差传递系数;当工作在非调节模式时,线运动误差传递系保持不变。
进一步的,本发明装置中,所述线运动误差补偿信号产生模块包括线运动检测模块、线运动误差传递系数输入模块、参考信号输入模块、线运动补偿信号产生模块,所述线运动检测模块包括加速度计和低通滤波器,用于检测重力梯度仪的加速度;所述加速度计安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的加速度ax,ay,az;所述低通滤波器则滤除加速度信号中的高频噪声;所述线运动误差传递系数输入模块用于输入线运动误差传递系数;所述参考信号产生模块用于输入正交幅度调制载波;所述线运动补偿信号产生模块根据输入的正交幅度调制载波、加速度信号、线运动误差传递系数产生线运动误差补偿信号。
进一步的,本发明装置中,所述线运动误差补偿信号产生模块具有两种工作模式:非补偿模式,补偿模式;非补偿模式下,产生的t时刻总的线运动误差补偿信号CL(t)为:
CL(t)=0;
补偿模式下,产生的t时刻总的线运动误差补偿信号CL(t)为:
式中sin2φt,cos2φt,sinφt,cosφt为t时刻输入线运动误差补偿信号产生模块的正交幅度调制载波;表示t时刻输入线运动误差补偿信号产生模块的线运动误差传递系数;ax(t),ay(t),az(t)表示t时刻输入线运动误差补偿信号产生模块的加速度信号。
进一步的,本发明装置中,所述补偿运算模块根据自梯度补偿信号产生模块输出的自梯度补偿信号、线运动误差补偿信号产生模块产生的线运动误差补偿信号、角运动误差补偿信号产生模块产生的角运动误差补偿信号,对重力梯度仪加速度计信号处理模块产生的含有自梯度误差、线运动误差、角运动误差的输出进行补偿。
本发明的动基座旋转加速度计重力梯度仪误差补偿方法,包括以下步骤:
1)根据反馈的补偿后的重力梯度仪信号及线运动误差传递系数处理模块的工作模式,计算t时刻的线运动误差传递系数:
式中表示t时刻的线运动误差传递系数,表示t-1时刻的线运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F1(gc(t-1))是t时刻线运动误差传递系数的微调量,它是gc(t-1)的函数;
根据反馈的补偿后的重力梯度仪信号及角运动误差传递系数处理模块的工作模式,计算t时刻的角运动误差传递系数:
式中表示t时刻的角运动误差传递系数,表示t-1时刻的角运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F2(gc(t-1))表示t时刻角运动误差传递系数的微调量,它是gc(t-1)的函数;t=0时刻的线运动误差传递系数角运动误差传递系数均通过标定得到;
根据反馈的补偿后的重力梯度仪信号,计算t时刻的加速度计标度系数:
式中表示安装在旋转圆盘上的四只加速度计在t时刻的标度系数,表示安装在旋转圆盘上的四只加速度计在t-1时刻的标度系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F3(gc(t-1))表示t时刻加速度计标度系数的调节量,它是gc(t-1)的函数;
2)检测旋转加速度计重力梯度仪旋转圆盘在t时刻的相位角φt,计算t时刻的正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt;检测旋转旋转加速度计重力梯度仪在t时刻的加速度ax(t),ay(t),az(t);检测旋转加速度计重力梯度仪在t时刻的角速度及角加速度ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t);
根据下式计算t时刻的3类线运动误差补偿信号CL1(t),CL2(t),CL3(t):
根据下式计算t时刻的3类角运动误差补偿信号CA1(t),CA2(t),CA3(t):
3)根据线运动误差补偿信号产生模块的工作模式,计算t时刻的总的线运动误差补偿信号CL(t):
非补偿模式时,CL(t)=0;
补偿模式时,CL(t)=CL1(t)+CL2(t)+CL3(t);
根据角运动误差补偿信号产生模块的工作模式,计算t时刻总的角运动误差补偿信号CA(t):
非补偿模式时,CA(t)=0;
正常模式时,CA(t)=CA1(t)+CA2(t)+CA3(t);
标定模式时,CA(t)=CA2(t)+CA3(t);
根据自梯度补偿信号产生模块的工作模式,计算t时刻的自梯度补偿信号Csg(t):
在非补偿模式时,Csg(t)=0;
4)对t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号g(t),根据下式进行线运动误差补偿、角运动误差补偿、自梯度补偿;
gc(t)=g(t)-CL(t)-Csg(t)-CA(t)
式中gc(t)是t时刻补偿后的重力梯度仪信号,g(t)是t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号,CL(t)是t时刻总的线运动误差补偿信号,Csg(t)是自梯度补偿信号,CA(t)是t时刻总的角运动误差补偿信号。
在动基座重力梯度勘探时,由于重力梯度仪内部的加速度计存在安装误差、加速度计一阶、高阶标度系数不匹配、电路增益不匹配等,导致重力梯度仪的加速度,角速度,角加速度传递到重力梯度仪的输出,造成测量误差,此外重力梯度仪的线运动误差传递系数、角运动误差传递系数容易受温度、电磁场等环境因素的影响。同时重力梯度仪的加速度,角速度,角加速度会引起重力梯度仪前端信号调理电路过电压饱和,或过电压损坏,本发明能够解决以上问题。
有益效果:本发明与现有技术相比,具有以下优点:
本发明是首次给出旋转加速度计重力梯度仪线运动误差、角运动误差、自梯度实时补偿装置及方法。本发明提供一种能够对重力梯度仪线运动误差、角运动误差、自梯度进行实时补偿的装置和方法,它根据反馈的补偿后的重力梯度仪信号实时微调角运动误差传递系数、线运动误差传递系数、加速度计标度系数,能够抵消重力梯度仪环境因素比如温度、磁场等对重力梯度仪线运动误差传递系数、角运动误差传递系数、标度系数的影响,能够补偿重力梯度仪线运动、角运动、自梯度引起的测量误差,提高重力梯度仪的测量精度。同时,对重力梯度仪线运动误差、角运动误差、自梯度信号进行了正交幅度调制,直接补偿重力梯度仪解调前的信号,因此还能够解决由于重力梯度仪加速度、角速度等引起的前端信号调理电路过电压饱和,过电压损坏问题。
附图说明
图1一种旋转加速度计重力梯度仪误差实时补偿装置原理图。
图2参考信号产生模块原理图。
图3线运动误差传递系数处理模块及角运动误差传递系数处理模块原理图。
图4角运动误差补偿信号产生模块及线运动误差补偿信号产生模块原理图。
图5角速度率传感器、加速度计安装示意图。
具体实施方式
下面结合实施例和说明书附图对本发明作进一步地说明。
如图1所示,本发明一种动基座旋转加速度计重力梯度仪误差补偿装置,包括:用于产生正交幅度调制载波的参考信号产生模块;用于实时产生自梯度补偿信号的自梯度补偿信号产生模块;用于实时产生重力梯度仪角运动误差补偿信号的角运动误差补偿信号产生模块,该模块还能检测重力梯度仪敏感的离心梯度;用于实时微调角运动误差传递系数的角运动误差传递系数处理模块;用于实时产生重力梯度仪线运动误差补偿信号的线运动误差补偿信号产生模块;用于实时微调线运动误差传递系数的线运动误差传递系数处理模块;用于对安装在旋转圆盘上的加速度计的输出信号求和、求差运算的重力梯度仪加速度计信号处理模块;用于实时调节加速度计标度系数的加速度计标度系数调节模块;用于对含有角运动误差,线运动误差,自梯度的重力梯度信号进行补偿的补偿运算模块;用于从补偿后的重力梯度仪信号解调输出重力梯度信号的重力梯度信号恢复模块;
所述参考信号产生模块的输出连接到自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块的输入;所述自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块、重力梯度仪加速度计信号处理模块的输出连接到补偿运算模块的输入;所述补偿运算模块的输出连接到加速度计标度系数调节模块、角运动误差传递系数处理模块、线运动误差传递系数处理模块、重力梯度信号恢复模块的输入;所述线运动误差传递系数处理模块的输出连接到线运动误差补偿信号产生模块的输入;所述角运动误差传递系数处理模块的输出连接到角运动误差补偿信号产生模块的输入;所述加速度计标度系数调节模块的输出连接到重力梯度仪加速度计信号处理模块的输入。
如图2所示,所述参考信号产生模块包括重力梯度仪旋转圆盘轴编码器和信号发生器;所述重力梯度仪旋转圆盘轴编码器检测重力梯度仪圆盘旋转的相位角φt,所述信号发生器根据相位角φt,产生正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt;
如图3(a)所示,所述角运动误差传递系数处理模块,由角运动误差传递系数初值设置模块,角运动误差传递系数调节模块组成;所述角运动误差传递系数初值设置模块,用于设置角运动误差传递系数初值:所述角运动误差传递差系数调节模块,根据反馈的补偿后的重力梯度仪信号产生调节量,微调角运动误差传递系数;角运动误差传递系数处理模块具有两种工作模式,调节模式和非调节模式,当工作在调节模式时,实时调节角运动误差传递系数;当工作在非调节模式时,角运动误差传递系保持不变。
如图4(b)所示,所述的角运动误差补偿信号产生模块由角运动误差传递系数输入模块,角运动检测模块,参考信号输入模块,角运动补偿信号产生模块,离心梯度检测模块组成;所述角运动误差传递系数输入模块用于输入角运动误差传递系数;所述参考信号输入模块用于输入正交幅度调制载波;所述角运动检测模块由角速率传感器及低通滤波器组成,用于检测重力梯度仪的角运动;如图5所示,所述角速率传感器安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的角速度ωx,ωy,ωz及角加速度ωax,ωay,ωaz;所述低通滤波器则滤除角速度、角加速度信号中的高频噪声;所述角运动误差产生模块根据正交幅度调制载波,角运动误差传递系数,角加速度,角速度,产生角运动误差补偿信号;所述离心梯度检测模块,有两种工作模式,标定模式和非标定模式,在标定模式下,离心梯度检测单元输出检测的离心梯度,在非标定模式下,离心梯度检测单元无输出;。
所述的角运动误差补偿信号产生模块具有三种工作模式,非补偿模式,正常模式,标定模式;非补偿模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
CA(t)=0;
在正常模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
式中sin2φt,cos2φt,sinφt,cosφt为t时刻输入角运动误差补偿信号产生模块的正交幅度调制载波;表示t时刻输入角运动误差补偿信号产生模块的角运动误差传递系数;ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t)表示t时刻输入角运动误差补偿信号产生模块的角运动信号;
如图3(b)所示,所述线运动误差传递系数处理模块,由线运动误差传递系数初值设置模块,线运动误差传递系数调节模块组成;所述线运动误差传递系数初值设置模块,设置线运动误差传递系数初值:所述线运动误差传递差系数调节模块,根据反馈的补偿后的重力梯度仪信号产生调节量,微调线运动误差传递系数;线运动误差传递系数处理模块具有两种工作模式,调节模式和非调节模式,当工作在调节模式时,实时调节线运动误差传递系数;当工作在非调节模式时,线运动误差传递系保持不变;
如图4(a)所示,所述线运动误差补偿信号产生模块由线运动检测模块,线运动误差传递系数输入模块,参考信号输入模块,组成;所述线运动检测模块由加速度计,低通滤波器组成,用于检测重力梯度仪的加速度;如图5所示,所述加速度计安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的加速度ax,ay,az;所述低通滤波器则滤除加速度信号中的高频噪声;所述线运动误差传递系数输入模块,用于输入线运动误差传递系数;所述参考信号产生模块用于输入正交幅度调制载波;所述线运动补偿信号产生模块根据输入的正交幅度调制载波,加速度信号,线运动误差传递系数产生线运动误差补偿信号。
所述线运动误差补偿信号产生模块具有两种工作模式:非补偿模式,补偿模式;非补偿模式下,产生的t时刻总的线运动误差补偿信号CL(t)为:
CL(t)=0;
补偿模式下,产生的t时刻总的线运动误差补偿信号CL(t)为:
式中sin2φt,cos2φt,sinφt,cosφt为t时刻输入线运动误差补偿信号产生模块的正交幅度调制载波;表示t时刻输入线运动误差补偿信号产生模块的线运动误差传递系数;ax(t),ay(t),az(t)表示t时刻输入线运动误差补偿信号产生模块的加速度信号。
所述补偿运算模块,根据自梯度补偿信号产生模块输出的自梯度补偿信号,线运动误差补偿信号产生模块产生的线运动误差补偿信号,角运动误差补偿信号产生模块产生的角运动误差补偿信号,对重力梯度仪加速度计信号处理模块产生的含有自梯度误差、线运动误差、角运动误差的输出进行补偿;
本发明的一种动基座旋转加速度计重力梯度仪误差补偿方法,包括以下步骤:
1)根据反馈的补偿后的重力梯度仪信号及线运动误差传递系数处理模块的工作模式,计算t时刻的线运动误差传递系数:
式中表示t时刻的线运动误差传递系数,表示t-1时刻的线运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F1(gc(t-1))是t时刻线运动误差传递系数的微调量,它是gc(t-1)的函数;
根据反馈的补偿后的重力梯度仪信号及角运动误差传递系数处理模块的工作模式,计算t时刻的角运动误差传递系数:
式中表示t时刻的角运动误差传递系数,表示t-1时刻的角运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F2(gc(t-1))表示t时刻角运动误差传递系数的微调量,它是gc(t-1)的函数;t=0时刻的线运动误差传递系数角运动误差传递系数通过标定得到;
根据反馈的补偿后的重力梯度仪信号,计算t时刻的加速度计标度系数:
式中表示安装在旋转圆盘上的四只加速度计在t时刻的标度系数,表示安装在旋转圆盘上的四只加速度计在t-1时刻的标度系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F3(gc(t-1))表示t时刻加速度计标度系数的调节量,它是gc(t-1)的函数;
2)检测旋转加速度计重力梯度仪旋转圆盘在t时刻的相位角φt,计算t时刻的正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt;检测旋转旋转加速度计重力梯度仪在t时刻的加速度ax(t),ay(t),az(t);检测旋转加速度计重力梯度仪在t时刻的角速度及角加速度ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t);
根据下式计算t时刻的3类线运动误差补偿信号CL1(t),CL2(t),CL3(t):
根据下式计算t时刻的3类角运动误差补偿信号CA1(t),CA2(t),CA3(t):
3)根据线运动误差补偿信号产生模块的工作模式,计算t时刻的总的线运动误差补偿信号CL(t):
非补偿模式时,CL(t)=0;
补偿模式时,CL(t)=CL1(t)+CL2(t)+CL3(t);
根据角运动误差补偿信号产生模块的工作模式,计算t时刻总的角运动误差补偿信号CA(t):
非补偿模式时,CA(t)=0;
正常模式时,CA(t)=CA1(t)+CA2(t)+CA3(t);
标定模式时,CA(t)=CA2(t)+CA3(t);
根据自梯度补偿信号产生模块的工作模式,计算t时刻的自梯度补偿信号Csg(t):
在非补偿模式时,Csg(t)=0;
4)对t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号g(t),根据下式进行线运动误差补偿、角运动误差补偿、自梯度补偿;
gc(t)=g(t)-CL(t)-Csg(t)-CA(t)
式中gc(t)是t时刻补偿后的重力梯度仪信号,g(t)是t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号,CL(t)是t时刻的线运动误差补偿信号,Csg(t)是自梯度补偿信号,CA(t)是角运动误差补偿信号。
Claims (10)
1.一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于,该装置包括:
用于产生正交幅度调制载波的参考信号产生模块;
用于实时产生自梯度补偿信号的自梯度补偿信号产生模块;
用于实时产生重力梯度仪角运动误差补偿信号及检测重力梯度仪离心梯度的角运动误差补偿信号产生模块;
用于实时微调角运动误差传递系数的角运动误差传递系数处理模块;
用于实时产生重力梯度仪线运动误差补偿信号的线运动误差补偿信号产生模块;
用于实时微调线运动误差传递系数的线运动误差传递系数处理模块;
用于对安装在旋转圆盘上的加速度计的输出信号求和、求差运算的重力梯度仪加速度计信号处理模块;
用于实时调节加速度计标度系数的加速度计标度系数调节模块;
用于对含有角运动误差,线运动误差,自梯度的重力梯度信号进行补偿的补偿运算模块;
用于从补偿后的重力梯度仪信号解调输出重力梯度信号的重力梯度信号恢复模块;
所述参考信号产生模块的输出连接到自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块的输入;所述自梯度补偿信号产生模块、角运动误差补偿信号产生模块、线运动误差补偿信号产生模块、重力梯度仪加速度计信号处理模块的输出连接到补偿运算模块的输入;所述补偿运算模块的输出连接到加速度计标度系数调节模块、角运动误差传递系数处理模块、线运动误差传递系数处理模块、重力梯度信号恢复模块的输入;所述线运动误差传递系数处理模块的输出连接到线运动误差补偿信号产生模块的输入;所述角运动误差传递系数处理模块的输出连接到角运动误差补偿信号产生模块的输入;所述加速度计标度系数调节模块的输出连接到重力梯度仪加速度计信号处理模块的输入。
2.如权利要求1所述的一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于:所述参考信号产生模块包括重力梯度仪旋转圆盘轴编码器和信号发生器;所述重力梯度仪旋转圆盘轴编码器检测重力梯度仪圆盘旋转的相位角φt,所述信号发生器根据相位角φt,产生正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt。
4.如权利要求1、2或3所述的一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于:所述的角运动误差补偿信号产生模块包括角运动误差传递系数输入模块、角运动检测模块、参考信号输入模块、角运动补偿信号产生模块、离心梯度检测模块;
所述角运动误差传递系数输入模块用于输入角运动误差传递系数;所述参考信号输入模块用于输入正交幅度调制载波;所述角运动检测模块包括角速率传感器和低通滤波器,用于检测重力梯度仪的角运动;所述角速率传感器安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的角速度ωx,ωy,ωz及角加速度ωax,ωay,ωaz;所述低通滤波器则滤除角速度、角加速度信号中的高频噪声;所述角运动补偿信号产生模块根据正交幅度调制载波、角运动误差传递系数、角加速度、角速度产生角运动误差补偿信号;所述离心梯度检测模块有两种工作模式,标定模式和非标定模式,在标定模式下,离心梯度检测单元输出检测的离心梯度,在非标定模式下,离心梯度检测单元无输出。
5.如权利要求1、2或3所述的一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于:所述的角运动误差补偿信号产生模块具有三种工作模式,非补偿模式,正常模式,标定模式;非补偿模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
CA(t)=0;
在正常模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
在标定模式下,产生的t时刻总的角运动误差补偿信号CA(t)为:
7.如权利要求1、2或3所述的一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于:所述线运动误差补偿信号产生模块包括线运动检测模块、线运动误差传递系数输入模块、参考信号输入模块、线运动补偿信号产生模块,所述线运动检测模块包括加速度计和低通滤波器,用于检测重力梯度仪的加速度;所述加速度计安装在重力梯度仪测量坐标系的x轴,y轴,z轴,测量重力梯度仪测量坐标系的加速度ax,ay,az;所述低通滤波器则滤除加速度信号中的高频噪声;所述线运动误差传递系数输入模块用于输入线运动误差传递系数;所述参考信号产生模块用于输入正交幅度调制载波;所述线运动补偿信号产生模块根据输入的正交幅度调制载波、加速度信号、线运动误差传递系数产生线运动误差补偿信号。
9.如权利要求1、2或3所述的一种动基座旋转加速度计重力梯度仪误差补偿装置,其特征在于:所述补偿运算模块根据自梯度补偿信号产生模块输出的自梯度补偿信号、线运动误差补偿信号产生模块产生的线运动误差补偿信号、角运动误差补偿信号产生模块产生的角运动误差补偿信号,对重力梯度仪加速度计信号处理模块产生的含有自梯度误差、线运动误差、角运动误差的输出进行补偿。
10.一种动基座旋转加速度计重力梯度仪误差补偿方法,其特征在于,该方法包括以下步骤:
1)根据反馈的补偿后的重力梯度仪信号及线运动误差传递系数处理模块的工作模式,计算t时刻的线运动误差传递系数:
式中表示t时刻的线运动误差传递系数,表示t-1时刻的线运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F1(gc(t-1))是t时刻线运动误差传递系数的微调量,它是gc(t-1)的函数;
根据反馈的补偿后的重力梯度仪信号及角运动误差传递系数处理模块的工作模式,计算t时刻的角运动误差传递系数:
式中表示t时刻的角运动误差传递系数,表示t-1时刻的角运动误差传递系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F2(gc(t-1))表示t时刻角运动误差传递系数的微调量,它是gc(t-1)的函数;t=0时刻的线运动误差传递系数角运动误差传递系数均通过标定得到;
根据反馈的补偿后的重力梯度仪信号,计算t时刻的加速度计标度系数:
式中表示安装在旋转圆盘上的四只加速度计在t时刻的标度系数,表示安装在旋转圆盘上的四只加速度计在t-1时刻的标度系数;gc(t-1)表示t-1时刻补偿后的重力梯度仪信号;F3(gc(t-1))表示t时刻加速度计标度系数的调节量,它是gc(t-1)的函数;
2)检测旋转加速度计重力梯度仪旋转圆盘在t时刻的相位角φt,计算t时刻的正交幅度调制载波sinφt,sin2φt,cosφt,cos2φt;检测旋转旋转加速度计重力梯度仪在t时刻的加速度ax(t),ay(t),az(t);检测旋转加速度计重力梯度仪在t时刻的角速度及角加速度ωx(t),ωy(t),ωz(t),ωax(t),ωay(t),ωaz(t);
根据下式计算t时刻的3类线运动误差补偿信号CL1(t),CL2(t),CL3(t):
根据下式计算t时刻的3类角运动误差补偿信号CA1(t),CA2(t),CA3(t):
3)根据线运动误差补偿信号产生模块的工作模式,计算t时刻的总的线运动误差补偿信号CL(t):
非补偿模式时,CL(t)=0;
补偿模式时,CL(t)=CL1(t)+CL2(t)+CL3(t);
根据角运动误差补偿信号产生模块的工作模式,计算t时刻总的角运动误差补偿信号CA(t):
非补偿模式时,CA(t)=0;
正常模式时,CA(t)=CA1(t)+CA2(t)+CA3(t);
标定模式时,CA(t)=CA2(t)+CA3(t);
根据自梯度补偿信号产生模块的工作模式,计算t时刻的自梯度补偿信号Csg(t):
在非补偿模式时,Csg(t)=0;
4)对t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号g(t),根据下式进行线运动误差补偿、角运动误差补偿、自梯度补偿;
gc(t)=g(t)-CL(t)-Csg(t)-CA(t)
式中gc(t)是t时刻补偿后的重力梯度仪信号,g(t)是t时刻含有线运动误差、角运动误差、自梯度的重力梯度仪信号,CL(t)是t时刻总的线运动误差补偿信号,Csg(t)是自梯度补偿信号,CA(t)是t时刻总的角运动误差补偿信号。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810985818.1A CN109212620B (zh) | 2018-08-27 | 2018-08-27 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
PCT/CN2019/089302 WO2020042696A1 (zh) | 2018-08-27 | 2019-05-30 | 一种动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810985818.1A CN109212620B (zh) | 2018-08-27 | 2018-08-27 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109212620A CN109212620A (zh) | 2019-01-15 |
CN109212620B true CN109212620B (zh) | 2020-01-07 |
Family
ID=64985949
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810985818.1A Active CN109212620B (zh) | 2018-08-27 | 2018-08-27 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109212620B (zh) |
WO (1) | WO2020042696A1 (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109212620B (zh) * | 2018-08-27 | 2020-01-07 | 东南大学 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
CN109709628B (zh) * | 2019-02-15 | 2020-08-14 | 东南大学 | 一种旋转加速度计重力梯度仪标定方法 |
CN114137447B (zh) * | 2022-02-07 | 2022-07-12 | 西南民族大学 | 磁梯度仪摆动噪声补偿方法、装置、电子设备及存储介质 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5357802A (en) * | 1993-05-07 | 1994-10-25 | Textron, Incorporated | Rotating accelerometer gradiometer |
US5922951A (en) * | 1997-06-11 | 1999-07-13 | The Broken Hill Proprietary Company Ltd. | Gravity gradiometer |
AUPS114702A0 (en) * | 2002-03-18 | 2002-04-18 | Bhp Billiton Innovation Pty Ltd | Enhancement of sensors for airborne operation |
US7444867B2 (en) * | 2005-01-04 | 2008-11-04 | Bell Geospace, Inc. | Accelerometer and rate sensor package for gravity gradiometer instruments |
WO2007038820A1 (en) * | 2005-10-06 | 2007-04-12 | Technological Resources Pty Limited | Gravity gradiometer |
CN105044798A (zh) * | 2015-06-29 | 2015-11-11 | 东南大学 | 旋转加速度计重力梯度仪加速度计标度因子反馈调整方法 |
CN105717553B (zh) * | 2016-01-29 | 2018-01-16 | 东南大学 | 一种旋转加速度计重力梯度仪标定方法 |
CN107870371B (zh) * | 2017-12-05 | 2019-04-30 | 东南大学 | 一种动基座重力梯度仪自梯度补偿方法 |
CN109212620B (zh) * | 2018-08-27 | 2020-01-07 | 东南大学 | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 |
-
2018
- 2018-08-27 CN CN201810985818.1A patent/CN109212620B/zh active Active
-
2019
- 2019-05-30 WO PCT/CN2019/089302 patent/WO2020042696A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
CN109212620A (zh) | 2019-01-15 |
WO2020042696A1 (zh) | 2020-03-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109212620B (zh) | 动基座旋转加速度计重力梯度仪误差补偿装置及方法 | |
CN106679649B (zh) | 一种手部运动追踪***及追踪方法 | |
CN109709628B (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN104101361B (zh) | 一种惯性平台角度传感器误差标定补偿方法 | |
CN104880189B (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN112325903B (zh) | 一种基于模式识别的惯性加速度滤波解耦方法 | |
CN105371846B (zh) | 载体姿态检测方法及其*** | |
CN104698485A (zh) | 基于bd、gps及mems的组合导航***及导航方法 | |
CN113885098B (zh) | 一种重力敏感器低频频率响应误差在线建模及补偿方法 | |
CN109141479A (zh) | 一种***级加速度计温度补偿方法 | |
CN101701970A (zh) | 一种加速度检测方法及装置 | |
CN106840100A (zh) | 一种数字式倾角传感器及测量方法 | |
CN104570142B (zh) | 一种重力梯度仪重力梯度测量信号的解调方法 | |
CN102095431A (zh) | 磁编码器数字转换器 | |
CN111650664B (zh) | 一种航空重力梯度仪实时重力梯度解调方法及装置 | |
CN111624671B (zh) | 旋转加速度计重力梯度仪重力梯度解调相位角确定方法及装置 | |
CN102072729A (zh) | 用于测量旋转飞行器姿态的测量装置及其测量方法 | |
CN109212629B (zh) | 旋转加速度计重力梯度仪角运动误差补偿装置及方法 | |
CN109212619B (zh) | 一种旋转加速度计重力梯度仪线运动误差补偿装置及方法 | |
CN112254717B (zh) | 一种基于冷原子干涉陀螺仪的惯性导航装置及方法 | |
CN108318000A (zh) | 一种通信铁塔倾角测量方法 | |
CN110133325B (zh) | 一种加速度计的重力场动态校准方法 | |
GB2568885A (en) | Methods and apparatus for performance testing of human powered vehicles | |
CN112345199A (zh) | 一种暂冲式高速风洞迎角传感器振动影响修正方法 | |
CN109085654B (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 |