CN106443827B - 一种用于动基座重力仪的动态精度评估方法 - Google Patents
一种用于动基座重力仪的动态精度评估方法 Download PDFInfo
- Publication number
- CN106443827B CN106443827B CN201610885088.9A CN201610885088A CN106443827B CN 106443827 B CN106443827 B CN 106443827B CN 201610885088 A CN201610885088 A CN 201610885088A CN 106443827 B CN106443827 B CN 106443827B
- Authority
- CN
- China
- Prior art keywords
- gravimeter
- moving base
- speed
- moment
- 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
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
- 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)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种用于动基座重力仪的动态精度评估方法,通过将动基座重力仪安装于特殊设计的试验车上,并选择合适的试验路段进行往复跑车测量,通过对比在同一路段上的多次重力异常值,可以实现动基座重力仪内符合精度的准确、有效评估,且方法简单,易于实现,成本低,效率高,此外本发明重力异常数据的处理方法,抗干扰能力强,具有较高的数据处理精度,特别适用于高精度动基座重力仪的重力异常提取,本发明可用于评估动基座重力仪的内外符合测量精度,适用于动基座重力仪的外场跑车测试。
Description
技术领域
本发明涉及一种用于动基座重力仪的动态精度评估方法,属于航空航天高精度惯性仪器的测试技术领域。
背景技术
发达国家掌握着航空、海洋、卫星等重力测量技术、仪器、重力场数据处理和应用技术,其尖端技术、仪器对我国实行封锁。我国重力测量技术现状远不能满足国防安全、国家经济建设及地球科学研究对精密重力测量的迫切需求。近年来,国内部分高校和科研院所在这一领域进行了研究,并形成了原理样机。由于国外的技术封锁,并不清楚国外对于仪器精度的评估方案。国内动基座重力仪精度评估多采用海洋或航空测量以交叉点的标准差评估内符合精度。但该方法试验成本太高,在地面试验对于重力测量仪器尚没有好的评估方案。
发明内容
本发明的目的在于克服现有技术的上述不足,提供一种用于动基座重力仪的动态精度评估方法,通过将捷联式动基座重力仪安装于特殊设计的试验车上,并选择合适的试验路段进行往复跑车测量,通过对比在同一路段上的多次重力异常值,可以实现捷联式动基座重力仪内符合精度的准确、有效评估,且方法简单,易于实现,成本低,效率高。
本发明的上述目的主要是通过如下技术方案予以实现的:
一种用于动基座重力仪的动态精度评估方法,包括如下步骤:
(1)、在地面架设差分GPS基站系统,所述GPS基站系统包括第一GPS接收机、第一GPS天线、第一记录设备和第一电源;
(2)、将动基座重力仪安装于减震架的减震器上,减震架固定连接在试验车地板上,
(3)、安装地面差分GPS移动站系统,所述GPS移动站系统包括第二GPS接收机、第二GPS天线、第二记录设备和第二电源,其中,第二GPS天线固定安装在试验车的顶部,与动基座重力仪的相对位置保持不变;
(4)、对动基座重力仪在校准点进行静态前校,并在选取的试验路段进行试验车的跑车试验,即:使试验车从校准点出发,到达试验路段的另一端后,转弯并沿原路返回至校准点,之后在校准点进行静态后校,完成一次闭环测量;
(5)、重复步骤(4),形成至少2次闭环测量,每次闭环测量得到一组动基座重力仪(1)记录的试验车(3)的速度增量和角速度增量,并发送给第二记录设备;
(6)、根据所述至少两组试验车(3)的速度增量、角速度增量以及第一记录设备、第二记录设备记录的数据,计算得到至少两组重力异常值;其中第一GPS接收机从第一GPS天线接收数据并发送给第一记录设备,第二GPS接收机从第二GPS天线接收数据并发送给第二记录设备;
(7)、根据所述至少两组重力异常值计算动基座重力仪的内符合精度,并将所述内符合精度与设定的阈值进行比较,若满足阈值要求,则表明动基座重力仪的动态测量精度满足要求。
在上述用于动基座重力仪的动态精度评估方法中,步骤(1)中在地面架设差分GPS基站系统时,架设地点选择在空旷的高地,即基站信号不被遮挡或不被环境干扰,并完成至少2小时的监视测量;如果测量范围较大,即测量基线长度超过100公里,则在测线中间位置架设基站,以保证全程GPS信号质量。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(1)中在地面架设的差分GPS基站系统还包括支架,其中将第一GPS天线固定在支架上,第一GPS接收机与第一GPS天线通过馈线连接,第一记录设备与第一GPS接收机通过数据线连接,第一电源为第一GPS接收机和第一记录设备供电。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(2)中定义动基座重力仪安装的坐标系为载体坐标系oxbybzb,动基座重力仪的三个轴向oxb、oyb和ozb分别指向动基座重力仪的右前上,安装时动基座重力仪的Y轴指向车头方向,即oxb、oyb和ozb指向试验车的右前上。
在上述用于动基座重力仪的动态精度评估方法中,所述减震架中部开设凹槽,且四端对称位置各安装一个减震器,动基座重力仪放置在所述凹槽中,并将重力仪的安装部位与四个减震器固定连接。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(4)中对动基座重力仪进行静态前校、后校的时间不少于20分钟;所述步骤(4)中试验车的跑车试验中,试验车保持匀速行驶,速度为40-45km/h。
在上述用于动基座重力仪的动态精度评估方法中,还包括动基座重力仪外符合精度的测量,具体为:采用手持式静态重力仪,在测线沿途选定若干测量点,测量各点的相对重力异常值,绘制测线段的重力异常曲线,选取的外符合基准点的间距取为3-5km/个。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(6)中根据所述至少两组试验车的速度增量、角速度增量以及第一GPS接收机、第二GPS接收机记录的数据,计算得到至少两组重力异常值的具体方法包括如下步骤:
(1)、将试验车的速度增量、角速度增量投影至载体坐标系下得到速度增量fb和角速度增量
(2)、进行捷联式海洋重力仪的动基座初始对准,获得从载体坐标系到实际数学平台坐标系的姿态转移矩阵所述姿态转移矩阵为对准时间段内最后时刻k时刻的姿态转移矩阵;
(3)、根据对准时间段内最后时刻k时刻的姿态转移矩阵获得导航过程中当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),其中ti为当前时刻;
(4)、将第一GPS接收机记录的数据设置为基站数据,将第二GPS接收机记录的数据设置为移动站数据,对所述基站数据和移动站数据进行差分处理获得包含载体运动信息的差分GPS数据;
(5)、根据捷联惯性系统误差方程,选取状态向量,构建卡尔曼滤波器的系统状态方程,根据步骤(3)中当前时刻的东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),以及步骤(4)中差分GPS数据中的当前时刻的东速VE,北速VN、经度λ和纬度L,得到相应东速的差值ve(ti)-VE、北速的差值vn(ti)-VN、经度的差值lon(ti)-λ和纬度的差值lat(ti)-L,作为卡尔曼滤波器的观测量进行东速误差、北速误差、经度误差、纬度误差和姿态误差的估计;
(6)、根据步骤(5)中得到的当前时刻的姿态误差修正东北天向比力值,得到修正后的东北天向比力值fn';
(7)、计算重力异常粗值δg,公式如下:
其中:gb为前校点处的重力基准值;
fu为fn'中的天向比力值;
为前校点处的天向比力初值;
au为天向运动加速度;
δaE为厄特弗斯改正;
δaF为自由空间改正;
γ0为正常重力改正;
δgdrift为零点漂移改正。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(3)中获得导航过程中当前时刻的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti)的具体方法如下:
根据导航过程中起始时刻,即第k+1时刻的速度增量fb(tk+1)、角速度增量和所述姿态转移矩阵获得导航过程中试验车在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1),根据试验车在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1),以及第k+2时刻的速度增量fb(tk+2)、角速度增量获得的试验车在第k+2时刻的姿态转移矩阵东速ve(tk+2)、北速vn(tk+2)、纬度lat(tk+2)和经度lon(tk+2),依次类推,获得试验车在导航过程中当前时刻的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti)。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(3)中姿态转移矩阵通过如下方法获得:
其中:
其中:为载体坐标系到实际数学平台坐标系的姿态转移矩阵,L代表大地纬度,ωie为地球自转角速度,t0为对准时间段内的初始对准时刻,tk为对准时间段内的任意时刻;
为载体坐标系到载体惯性坐标系的姿态转移矩阵,具体表达式为:
式中:q0q1q2q3为对准数据段最后时刻k的四元素;
为载体惯性坐标系到经线地心惯性坐标系的姿态转移矩阵,具体表达式为:
其中:g为地球重力值,分别计算Vi(tk1)和Vi(tk2)的值,tk1和tk2分别是对准时段内的两个时刻;
Δtk=tk-t0,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量。
在上述用于动基座重力仪的动态精度评估方法中,所述载体坐标系到载体惯性坐标系的姿态转移矩通过如下方法获得:
(3.1)、初始对准时刻t0,载体坐标系到载体惯性坐标系的姿态转移矩阵表示如下:
其中:I为3阶单位矩阵,其对应的初始时刻四元素为Q(t0)=[1 0 0 0];
(3.2)、根据t0时刻的四元素Q(t0)和t1时刻的角速度增量获得t1时刻的四元素其中,Φ=|Φ|;
(3.3)、根据t1时刻的四元素Q(t1)和t2时刻的角速度增量获得t2时刻的四元素Q(t2),依次类推,获得对准数据段最后时刻k时刻的四元素Q(k)=[q0 q1 q2 q3],根据Q(k)计算如下:
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(4)中差分GPS数据包括GPS时间、经度λ、纬度L、海拔高、大地高、东北天速度(VE,VN,VU)、东北天加速度、卫星数、PDOP、HDOP、VDOP、质量数Q以及GPS周。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(5)中根据捷联惯性系统误差方程,选取的状态向量XINS为13阶,具体表示如下:
其中:δL为纬度误差;
δλ为经度误差;
δve、δvn分别为东速误差和北速误差;
φe、φn和φu分别为三个姿态误差角;
εx、εy和εz为激光陀螺的零位;
和为加速度计零位。
在上述用于动基座重力仪的动态精度评估方法中,所述步骤(6)中修正后的东北天向比力值fn'表示如下:
其中:φ×为反对称阵,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量;
ΔT为系统采样间隔时间。
在上述用于动基座重力仪的动态精度评估方法中,对所述步骤(7)中计算的重力异常粗值δg采用数字滤波器进行滤波处理,以提高数据精度。
在上述用于动基座重力仪的动态精度评估方法中,所述数字滤波采用FIR和IIR低通滤波器,截止频率小于0.01Hz;或者采用正反卡尔曼滤波器。
本发明与现有技术相比的优点在于:
(1)、本发明通过将捷联式动基座重力仪安装于特殊设计的试验车上,并选择合适的试验路段进行往复跑车测量,通过对比在同一路段上的多次重力异常值,可以实现捷联式动基座重力仪内符合精度的准确、有效评估;
(2)、本发明针对捷联式动基座重力仪的陆地跑车测量环境,设计了专用的试验车工装,能有效衰减由于路面颠簸和环境带来了冲击干扰。
(3)、本发明在地面环境下,不易形成交叉点,通过往返测线的测量方式获得测量路段的重力异常重复测量值,进而可按经纬度进行内符合评估;
(4)、本发明对重力异常值的计算方法,抗干扰能力强,具有较高的数据处理精度,可以作为高精度捷联式动基座重力仪异常提取的数据处理方法;
(5)、本发明对重力异常值的计算过程中,采用kalman滤波器,估计惯性导航解算中的姿态误差,对姿态矩阵和垂向比力分量进行修正,得到更为精确的比力信息,再由差分GPS技术得提供的位置、速度和高度信息计算重力各改正项,最后经低通滤波得到沿测线的重力异常信息,本发明可用于捷联式动基座重力仪的车载重力测量数据处理,抗干扰能力强,具有较高的数据处理精度,特别适用于捷联式动基座重力仪的车载重力测量数据处理;
(6)、本发明对重力异常值的计算过程中,在初始对准阶段,采用了惯性凝固假设,进行动基座初始对准,可以有效减小由于载体晃动带来的姿态误差,提高初始对准精度;
(7)、本发明对重力异常值的计算过程中,采用差分GPS技术处理车载试验过程中的GPS数据,获得较高精度的载体运动信息;采用组合导航技术获取天向比力信息,经过改正计算后,通过数字低通方式去除高频噪声得到高精度的重力异常信号。
(8)、本发明对重力异常值的计算过程中,可以采用数字低通滤波器对计算得到的重力异常粗值去噪处理,截止频率小于0.01Hz,进一步提高了重力异常信号的精度。
(9)、本发明采用相对式静态重力仪在沿途测线段中选取若干重力测量点,在测线上形成若干离散的测量点作为测线段重力异常的基准值,通过对比跑车测量与静态测量基准点的重力异常值,可以评估仪器的外符合精度。
(10)、本发明方法实现方便,成本低,并且条件许可的情况下,可以对多台套重力仪同时进行测试,测试效率高。
附图说明
图1为本发明动基座重力仪的动态精度评估方法的工作流程图;
图2为本发明动基座重力仪在试验车上的安装示意图;
图3为本发明重力仪与减震架的安装示意图。
图4为本发明动基座重力仪的安装坐标图;
图5为本发明重力异常数据处理方法的工作流程图;
图6为本发明重力异常数据处理方法中载体坐标系、导航坐标系和实际数学平台坐标系之间关系示意图;
图7为本发明重力异常数据处理方法中针对的捷联式海洋重力仪的硬件安装示意图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
本发明提出的用于动基座重力仪的动态精度评估方法,采用车载试验方式,沿预定测线往返测量,通过测线重复测量结果评估仪器的内符合精度,还可以通过手持式相对重力仪引入外部基准点的方式评估仪器的外符合精度。其具体实施方式如下所述:
步骤(一)、在地面架设差分GPS基站系统,所述GPS基站系统包括第一GPS接收机、第一GPS天线、支架、第一记录设备和第一电源。其中将第一GPS天线固定在支架上,第一GPS接收机与第一GPS天线通过馈线连接,第一记录设备与第一GPS接收机通过数据线连接,第一电源为第一GPS接收机和第一记录设备供电。
在地面架设差分GPS基站系统时,架设地点选择在空旷的高地,即基站信号不被遮挡或不被环境干扰,并完成至少2小时的监视测量;如果测量范围较大,即测量基线长度超过100公里,则在测线中间位置架设基站,以保证全程GPS信号质量。
步骤(二)、将动基座重力仪1安装于减震架2的减震器6上,减震架2固定连接在试验车3地板上。如图2所示为本发明动基座重力仪在试验车上的安装示意图。如图3所示为本发明重力仪与减震架的安装示意图,由图可知,减震架2中部开设凹槽,且四端对称位置各安装一个减震器6,动基座重力仪1放置在所述凹槽中,并通过螺钉将重力仪的安装部位与四个减震器6固定连接。
当路面颠簸时,车辆在行驶过程中会产生垂向运动加速度,该运动会传导至减震架。由于重力仪是通过4个减震器与减震支架固连,因此,能在很大程度上隔绝由路面颠簸导致的垂向运动加速度。
定义动基座重力仪1安装的坐标系为载体坐标系oxbybzb,动基座重力仪1的三个轴向oxb、oyb和ozb分别指向动基座重力仪1的右前上,安装时动基座重力仪1的Y轴指向车头方向,即oxb、oyb和ozb指向工程车的右前上。如图4所示为本发明动基座重力仪的安装坐标图。
步骤(三)、安装地面差分GPS移动站系统,所述GPS移动站系统包括第二GPS接收机、第二GPS天线4、第二记录设备和第二电源,其中,第二GPS天线4固定安装在试验车3的顶部,与动基座重力仪1的相对位置保持不变;
步骤(四)、对仪器进行充分预热后,在试验路段的一端选取合适的校准点,进行不少于20分钟的静态前校。
步骤(五)、在选取的试验路段进行试验车3的跑车试验,即使试验车3从校准点出发,到达试验路段的另一端后,转弯并沿原路返回至校准点,之后在校准点进行静态后校,完成一次闭环测量。在试验时,试验车3保持匀速行驶,避免急起急停。例如对于长度为60km的测量基线载体的行驶速度为40-45km/h。
步骤(六)、重复步骤(五),形成至少2次闭环测量,每次闭环测量得到一组动基座重力仪1记录的试验车(3)的速度增量和角速度增量;并发送给第二记录设备;
步骤(七)、根据所述至少两组试验车3的速度增量、角速度增量以及第一记录设备、第二记录设备记录的数据,计算得到至少两组重力异常值;其中第一GPS接收机从第一GPS天线接收数据并发送给第一记录设备,第二GPS接收机从第二GPS天线接收数据并发送给第二记录设备。
重力异常值具体的计算方法如下:
如图5所示为本发明重力异常数据处理方法的工作流程图,本发明重力异常数据处理方法具体包括如下步骤:
(1)、定义动基座重力仪1安装的坐标系为载体坐标系oxbybzb,动基座重力仪1的三个轴向oxb、oyb和ozb分别指向动基座重力仪1的右前上,安装时动基座重力仪1的Y轴指向车头方向,即oxb、oyb和ozb指向工程车的右前上,如图7所示为本发明所针对的捷联式重力仪的硬件安装示意图。
重力仪实时记录载体的速度增量和角速度增量,并投影至载体坐标系下得到速度增量fb和角速度增量
(2)采用了惯性凝固假设,进行捷联式动基座重力仪的动基座初始对准,获得从载体坐标系到实际数学平台坐标系的姿态转移矩阵所述姿态转移矩阵为对准时间段内最后时刻k时刻的姿态转移矩阵。
对载体坐标系(b系)到实际数学平台坐标系(n系)的姿态转移矩阵进行初始化设定;重力数据处理中,导航坐标系通常选为地理坐标系。如图6所示为本发明载体坐标系、导航坐标系和实际数学平台坐标系之间关系示意图。
该方法用到的坐标系定义如下:
a)经线地球坐标系e:原点位于地心,oze轴沿地球自转轴方向,oxe轴位于赤道平面内,从地心指向重力仪所在点经线,oye轴在赤道平面内,oxe、oye、oze轴构成右手坐标系。
b)经线地心惯性坐标系i:在对准起始时刻t0时刻将经线地球坐标系oxeyeze惯性凝固后形成的坐标系。
c)导航坐标系n’:原点位于捷联式动基座重力仪中心,ox轴指向东(E),oy轴指向北(N),oz轴指向天(U)。
d)实际数学平台坐标系n:坐标系Ox1y1z1,近似指向东北天,与理想导航坐标n’系之间存在失准角,例如,水平失准角(φe、φn)为0.005°,方位失准角φu为0.08°。
e)载体系b系:坐标系Oxbybzb,原点位于载体质心,xb、yb和zb指向载体右前上。
f)载体惯性坐标系ib0:在对准起始时刻t0时刻将载体坐标系oxbybzb经惯性凝固后的坐标系。
动基座初始对准算法中,姿态阵分散成4个矩阵求取。设对准点的纬度为L,则姿态转移矩阵通过如下方法获得:
其中:
其中:为载体坐标系到实际数学平台坐标系的姿态转移矩阵,L代表大地纬度,ωie为地球自转角速度,t0为对准时间段内的初始对准时刻,tk为对准时间段内的任意时刻;
为载体坐标系到载体惯性坐标系的姿态转移矩阵,具体表达式为:
式中:q0q1q2q3为对准数据段最后时刻k的四元素。
载体坐标系到载体惯性坐标系的姿态转移矩通过如下方法获得:
(a)、初始对准时刻t0,载体坐标系到载体惯性坐标系的姿态转移矩阵表示如下:
其中:I为3阶单位矩阵,其对应的初始时刻四元素为Q(t0)=[1 0 0 0];
(b)、根据t0时刻的四元素Q(t0)和t1时刻的角速度增量获得t1时刻的四元素其中,Φ=|Φ|;
(c)、根据t1时刻的四元素Q(t1)和t2时刻的角速度增量获得t2时刻的四元素Q(t2),依次类推,获得对准数据段最后时刻k时刻的四元素Q(k)=[q0 q1 q2 q3],根据Q(k)计算如下:
为载体惯性坐标系到经线地心惯性坐标系的姿态转移矩阵,具体表达式为:
其中:g为地球重力值,分别计算Vi(tk1)和Vi(tk2)的值,tk1和tk2分别是对准时段内的两个时刻;
Δtk=tk-t0,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量。
(3)、根据对准时间段内最后时刻k时刻的姿态转移矩阵获得载体导航过程中当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),其中ti为当前时刻;具体方法如下:
根据导航过程中起始时刻,即第k+1时刻的速度增量fb(tk+1)、角速度增量和所述姿态转移矩阵获得导航过程中试验车在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1);
根据载体在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1),以及第k+2时刻的速度增量fb(tk+2)、角速度增量获得的载体在第k+2时刻的姿态转移矩阵东速ve(tk+2)、北速vn(tk+2)、纬度lat(tk+2)和经度lon(tk+2);
根据载体在第k+2时刻的姿态转移矩阵东速ve(tk+2)、北速vn(tk+2)、纬度lat(tk+2)和经度lon(tk+2),以及第k+3时刻的加速度增量fb(tk+3)、角速度增量获得的载体在第k+3时刻的姿态转移矩阵东速ve(tk+3)、北速vn(tk+3)、纬度lat(tk+3)和经度lon(tk+3)。
依次类推,获得载体在导航过程中当前时刻的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti)。按照上述方法可以获得载体在导航过程中各时刻的姿态转移矩阵东速ve(t)、北速vn(t)、纬度lat(t)和经度lon(t)。
(4)、将第一GPS接收机记录的数据设置为基站数据,将第二GPS接收机记录的数据设置为移动站数据,对所述基站数据和移动站数据进行差分处理获得包含载体运动信息的差分GPS数据。也就是根据载体测量期间记录的GPS的基站数据和移动站数据,采用waypoint软件中的差分GPS技术,获得差分GPS信息,包括GPS时间、经度λ、纬度L、海拔高、大地高、东北天速度(VE,VN,VU)、东北天加速度、卫星数、PDOP、HDOP、VDOP、质量数Q以及GPS周。获得差分GPS数据后,进行步骤(5)。
(5)、根据捷联惯性系统误差方程,选取状态向量,构建卡尔曼滤波器的系统状态方程,根据步骤(3)中当前时刻的东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),以及步骤(4)中差分GPS数据中的当前时刻的东速VE,北速VN、经度λ和纬度L,得到相应东速的差值ve(ti)-VE、北速的差值vn(ti)-VN、经度的差值lon(ti)-λ和纬度的差值lat(ti)-L,作为卡尔曼滤波器的观测量进行东速误差、北速误差、经度误差、纬度误差和姿态误差的估计。
根据kalman滤波器估计修正各项参数误差,特别是位置、速度和姿态误差,修正分为开环和闭环修正两种方式。完成后,进入步骤(6)。
选取的状态向量XINS为13阶,具体表示如下:
根据测量环境,忽略部分非主要误差参数,采用了如下的捷联惯性系统的误差方程
式中,δL为纬度误差;
δλ为经度误差;
δve、δvn分别为东、北速误差;
φe、φn和φu分别为三个姿态误差角,通常情况下,φ为小量;
εx、εy和εz为激光陀螺的零位;
和为加速度计零位;
Tij(i=1,2,3;j=1,2,3)为姿态阵的元素。
(6)、根据步骤(5)中得到的当前时刻姿态误差,修正东北天向比力值,得到修正后的东北天向比力值fn',完成修正后进入步骤(7)。
其中:φ×为反对称阵,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量;
ΔT为系统采样间隔时间。
(7)、计算重力异常粗值δg,公式如下:
式中:
gb为前校点处的重力基准值,如果没有基准值,则采用前校段的天向比力值代替;
fu为fn'中的天向比力值;
为前校点处的天向比力初值;
au为天向运动加速度;
δaE为厄特弗斯改正;
δaF为自由空间改正;
γ0为正常重力改正;
δgdrift为零点漂移改正,零点漂移改正为每个航次重力测量时不同时间在同一点的观测值变化的改正。
其中计算重力异常各改正项,包括厄特弗斯改正、天向运动加速度、正常重力改正、自有空间改正、零点漂移改正,各改正项计算公式如下。厄特弗斯:
天向运动加速度:
可以根据GPS提供的伪距、载波相位和多普勒频移观测值,以及其单差、双差组建观测方程,利用最小二乘法,求出载体位置、速度和加速度。然后利用差分GPS数据,采用位置差分、速度差分或者载波相位差分等方法计算天向运动加速度。
正常重力:
γ0=9.780327(1+0.0053024sin2L-0.0000058sin22L)
自由空间:
零点漂移改正:
重力测量的零点漂移率可按线性化近似计算,有
其中,C为此次测量的零点漂移变化率,f1 u和分别为前后校基准点处的天向比力值,g1 b和分别为前后校基准点处的重力场,t1和t0分别对应f1 u和的观测时间。
则零点漂移改正值为
δgdrift=C·(t-t0)
式中,C为此次测量的零点漂移变化率,Δti为第i个测点的测量时刻与在基准点前校时刻的时间差。
完成计算后进入步骤(8)。
(8)采用数字滤波器对δg进行滤波,得到高精度重力异常信号,采用滤波器可采用FIR和IIR滤波器,截止频率小于0.01Hz;也可采用正反kalman滤波器。
步骤(八)、根据所述至少两组重力异常值计算动基座重力仪1的内符合精度,并将所述内符合精度与设定的阈值进行比较,若满足阈值要求(即内符合精度小于或等于阈值),则表明动基座重力仪1的动态测量精度满足要求。
如果具备测量条件,可采用CG-5等手持式静态重力仪,在测线沿途选定若干测量点,测量各点的相对重力异常值,绘制测线段的重力异常曲线。建议重力异常测点的间距5km左右,可用于评估仪器的外符合精度。选取的外符合基准点的间距取为3-5km/个,60km试验路段选择的外基准点数为12-20个。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (14)
1.一种用于动基座重力仪的动态精度评估方法,其特征在于:包括如下步骤:
(1)、在地面架设差分GPS基站系统,所述GPS基站系统包括第一GPS接收机、第一GPS天线、第一记录设备和第一电源;
(2)、将动基座重力仪(1)安装于减震架(2)的减震器(6)上,减震架(2)固定连接在试验车(3)地板上,
(3)、安装地面差分GPS移动站系统,所述GPS移动站系统包括第二GPS接收机、第二GPS天线(4)、第二记录设备和第二电源,其中,第二GPS天线(4)固定安装在试验车(3)的顶部,与动基座重力仪(1)的相对位置保持不变;
(4)、对动基座重力仪(1)在校准点进行静态前校,并在选取的试验路段进行试验车(3)的跑车试验,即:使试验车(3)从校准点出发,到达试验路段的另一端后,转弯并沿原路返回至校准点,之后在校准点进行静态后校,完成一次闭环测量;
(5)、重复步骤(4),形成至少2次闭环测量,每次闭环测量得到一组动基座重力仪(1)记录的试验车(3)的速度增量和角速度增量,并发送给第二记录设备;
(6)、根据所述至少两组试验车(3)的速度增量、角速度增量以及第一记录设备、第二记录设备记录的数据,计算得到至少两组重力异常值;其中第一GPS接收机从第一GPS天线接收数据并发送给第一记录设备,第二GPS接收机从第二GPS天线接收数据并发送给第二记录设备;
(7)、根据所述至少两组重力异常值计算动基座重力仪(1)的内符合精度,并将所述内符合精度与设定的阈值进行比较,若满足阈值要求,则表明动基座重力仪(1)的动态测量精度满足要求;
所述步骤(6)中根据所述至少两组试验车(3)的速度增量、角速度增量以及第一GPS接收机、第二GPS接收机记录的数据,计算得到至少两组重力异常值的具体方法包括如下步骤:
(6.1)、将试验车(3)的速度增量、角速度增量投影至载体坐标系下得到速度增量fb和角速度增量
(6.2)、进行捷联式海洋重力仪的动基座初始对准,获得从载体坐标系到实际数学平台坐标系的姿态转移矩阵所述姿态转移矩阵为对准时间段内最后时刻k时刻的姿态转移矩阵;
(6.3)、根据对准时间段内最后时刻k时刻的姿态转移矩阵获得导航过程中当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),其中ti为当前时刻;
(6.4)、将第一GPS接收机记录的数据设置为基站数据,将第二GPS接收机记录的数据设置为移动站数据,对所述基站数据和移动站数据进行差分处理获得包含载体运动信息的差分GPS数据;
(6.5)、根据捷联惯性系统误差方程,选取状态向量,构建卡尔曼滤波器的系统状态方程,根据步骤(6.3)中当前时刻的东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti),以及步骤(6.4)中差分GPS数据中的当前时刻的东速VE,北速VN、经度λ和纬度L,得到相应东速的差值ve(ti)-VE、北速的差值vn(ti)-VN、经度的差值lon(ti)-λ和纬度的差值lat(ti)-L,作为卡尔曼滤波器的观测量,进行东速误差、北速误差、经度误差、纬度误差和姿态误差的估计;
(6.6)、根据步骤(6.5)中得到的当前时刻的姿态误差修正东北天向比力值,得到修正后的东北天向比力值fn';
(6.7)、计算重力异常粗值δg,公式如下:
其中:gb为前校点处的重力基准值;
fu为fn'中的天向比力值;
为前校点处的天向比力初值;
au为天向运动加速度;
δaE为厄特弗斯改正;
δaF为自由空间改正;
γ0为正常重力改正;
δgdrift为零点漂移改正;
所述步骤(6.6)中修正后的东北天向比力值fn'表示如下:
其中:φ×为反对称阵,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量;
ΔT为系统采样间隔时间。
2.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(1)中在地面架设差分GPS基站系统时,架设地点选择在空旷的高地,即基站信号不被遮挡或不被环境干扰,并完成至少2小时的监视测量;如果测量范围较大,即测量基线长度超过100公里,则在测线中间位置架设基站,以保证全程GPS信号质量。
3.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(1)中在地面架设的差分GPS基站系统还包括支架,其中将第一GPS天线固定在支架上,第一GPS接收机与第一GPS天线通过馈线连接,第一记录设备与第一GPS接收机通过数据线连接,第一电源为第一GPS接收机和第一记录设备供电。
4.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(2)中定义动基座重力仪(1)安装的坐标系为载体坐标系oxbybzb,动基座重力仪(1)的三个轴向oxb、oyb和ozb分别指向动基座重力仪(1)的右前上,安装时动基座重力仪(1)的Y轴指向车头方向,即oxb、oyb和ozb指向试验车(3)的右前上。
5.根据权利要求4所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述减震架(2)中部开设凹槽,且四端对称位置各安装一个减震器(6),动基座重力仪(1)放置在所述凹槽中,并将重力仪的安装部位与四个减震器(6)固定连接。
6.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(4)中对动基座重力仪(1)进行静态前校、后校的时间不少于20分钟;所述步骤(4)中试验车(3)的跑车试验中,试验车(3)保持匀速行驶,速度为40-45km/h。
7.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:还包括动基座重力仪(1)外符合精度的测量,具体为:采用手持式静态重力仪,在测线沿途选定若干测量点,测量各点的相对重力异常值,绘制测线段的重力异常曲线,选取的外符合基准点的间距取为3-5km/个。
8.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(6.3)中获得导航过程中当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti)的具体方法如下:
根据导航过程中起始时刻,即第k+1时刻的速度增量fb(tk+1)、角速度增量和所述姿态转移矩阵获得导航过程中试验车在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1),根据试验车在第k+1时刻的姿态转移矩阵东速ve(tk+1)、北速vn(tk+1)、纬度lat(tk+1)和经度lon(tk+1),以及第k+2时刻的速度增量fb(tk+2)、角速度增量获得的试验车在第k+2时刻的姿态转移矩阵东速ve(tk+2)、北速vn(tk+2)、纬度lat(tk+2)和经度lon(tk+2),依次类推,获得试验车在导航过程中当前时刻的姿态转移矩阵东速ve(ti)、北速vn(ti)、纬度lat(ti)和经度lon(ti)。
9.根据权利要求1所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(6.3)中姿态转移矩阵通过如下方法获得:
其中:
其中:为载体坐标系到实际数学平台坐标系的姿态转移矩阵,L代表大地纬度,ωie为地球自转角速度,t0为对准时间段内的初始对准时刻,tk为对准时间段内的任意时刻;
为载体坐标系到载体惯性坐标系的姿态转移矩阵,具体表达式为:
式中:q0、q1、q2、q3为对准数据段最后时刻k的四元素;
为载体惯性坐标系到经线地心惯性坐标系的姿态转移矩阵,具体表达式为:
其中:g为地球重力值,分别计算Vi(tk1)和Vi(tk2)的值,tk1和tk2分别是对准时段内的两个时刻;
Δtk=tk-t0,
为当前时刻从载体坐标系到实际数学平台坐标系的姿态转移矩阵;
fb(ti)为当前时刻的速度增量。
10.根据权利要求9所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述载体坐标系到载体惯性坐标系的姿态转移矩通过如下方法获得:
(3.1)、初始对准时刻t0,载体坐标系到载体惯性坐标系的姿态转移矩阵表示如下:
其中:I为3阶单位矩阵,其对应的初始时刻四元素为Q(t0)=[1000];
(3.2)、根据t0时刻的四元素Q(t0)和t1时刻的角速度增量获得t1时刻的四元素其中,Φ=|Φ|;
(3.3)、根据t1时刻的四元素Q(t1)和t2时刻的角速度增量获得t2时刻的四元素Q(t2),依次类推,获得对准数据段最后时刻k时刻的四元素Q(k)=[q0 q1 q2 q3],根据Q(k)计算如下:
11.根据权利要求1~10之一所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(4)中差分GPS数据包括GPS时间、经度λ、纬度L、海拔高、大地高、东北天速度(VE,VN,VU)、东北天加速度、卫星数、PDOP、HDOP、VDOP、质量数Q以及GPS周。
12.根据权利要求1~10之一所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述步骤(5)中根据捷联惯性系统误差方程,选取的状态向量XINS为13阶,具体表示如下:
其中:δL为纬度误差;
δλ为经度误差;
δve、δvn分别为东速误差和北速误差;
φe、φn和φu分别为三个姿态误差角;
εx、εy和εz为激光陀螺的零位;
和为加速度计零位。
13.根据权利要求1~10之一所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:对所述步骤(7)中计算的重力异常粗值δg采用数字滤波器进行滤波处理,以提高数据精度。
14.根据权利要求13所述的一种用于动基座重力仪的动态精度评估方法,其特征在于:所述数字滤波采用FIR和IIR低通滤波器,截止频率小于0.01Hz;或者采用正反卡尔曼滤波器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610885088.9A CN106443827B (zh) | 2016-10-10 | 2016-10-10 | 一种用于动基座重力仪的动态精度评估方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610885088.9A CN106443827B (zh) | 2016-10-10 | 2016-10-10 | 一种用于动基座重力仪的动态精度评估方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106443827A CN106443827A (zh) | 2017-02-22 |
CN106443827B true CN106443827B (zh) | 2018-06-19 |
Family
ID=58172462
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610885088.9A Active CN106443827B (zh) | 2016-10-10 | 2016-10-10 | 一种用于动基座重力仪的动态精度评估方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106443827B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106990420B (zh) * | 2017-05-05 | 2020-06-30 | 苍穹数码技术股份有限公司 | 一种设置于载体上的方向基准引出装置及方法 |
CN111279178A (zh) * | 2017-08-31 | 2020-06-12 | 单尼斯科仪器仪表有限公司 | 用于对测量聚合物熔体流动指数时的重力变化的校正 |
CN108931824B (zh) * | 2018-04-27 | 2020-02-18 | 东南大学 | 一种动基座旋转加速度计重力梯度仪误差增益系数标定方法 |
CN111121817B (zh) * | 2018-11-01 | 2023-02-10 | 北京自动化控制设备研究所 | 一种用于平台式重力仪晃动基座下精密自标定方法 |
CN110231665B (zh) * | 2019-07-12 | 2020-09-08 | 中国人民解放军国防科技大学 | 基于重复线的捷联式航空重力测量精度评估方法 |
CN111505727A (zh) * | 2020-04-16 | 2020-08-07 | 清华大学 | 基于多传感器数据融合的振动补偿方法及系统 |
CN112346140B (zh) * | 2020-10-15 | 2022-10-14 | 北京航天控制仪器研究所 | 一种捷联式海洋重力仪主机减摇装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1862763A2 (en) * | 2006-05-31 | 2007-12-05 | Honeywell International Inc. | Rapid self-alignment of a strapdown inertial system through real-time reprocessing |
CN101566477A (zh) * | 2009-06-03 | 2009-10-28 | 哈尔滨工程大学 | 舰船局部捷联惯导系统初始姿态快速测量方法 |
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN103955005A (zh) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | 一种火箭橇轨道重力实时测量方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ITCO20110018A1 (it) * | 2011-05-20 | 2012-11-21 | Andrea Segalini | Apparecchiatura per rilevare movimenti di terreno nel sottosuolo e disposizione che la utilizza |
-
2016
- 2016-10-10 CN CN201610885088.9A patent/CN106443827B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1862763A2 (en) * | 2006-05-31 | 2007-12-05 | Honeywell International Inc. | Rapid self-alignment of a strapdown inertial system through real-time reprocessing |
CN101566477A (zh) * | 2009-06-03 | 2009-10-28 | 哈尔滨工程大学 | 舰船局部捷联惯导系统初始姿态快速测量方法 |
CN103674030A (zh) * | 2013-12-26 | 2014-03-26 | 中国人民解放军国防科学技术大学 | 基于天文姿态基准保持的垂线偏差动态测量装置和方法 |
CN103955005A (zh) * | 2014-05-12 | 2014-07-30 | 北京航天控制仪器研究所 | 一种火箭橇轨道重力实时测量方法 |
Non-Patent Citations (3)
Title |
---|
捷联式惯导系统初始对准方法研究;李东明;《中国优秀博硕士学位论文全文数据库(博士)信息科学辑》;20061115(第11期);第I136-150页 * |
海空重力测量数椐处理关键技术研究;欧阳永忠;《中国优秀博硕士学位论文全文数据库(博士)信息科学辑》;20150215(第2期);第A008-35页 * |
激光捷联惯导车载重力测量试验;李东明 等;《导航与控制》;20131130;第12卷(第4期);第74-78页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106443827A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106443827B (zh) | 一种用于动基座重力仪的动态精度评估方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN108051866B (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN105043415B (zh) | 基于四元数模型的惯性系自对准方法 | |
CN105928515B (zh) | 一种无人机导航系统 | |
CN105929836B (zh) | 用于四旋翼飞行器的控制方法 | |
Cai et al. | The first airborne scalar gravimetry system based on SINS/DGPS in China | |
CN104764467B (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN101021879A (zh) | 惯性测量系统误差模型验证试验方法 | |
CN102169184A (zh) | 组合导航系统中测量双天线gps安装失准角的方法和装置 | |
CN109471144A (zh) | 基于伪距/伪距率的多传感器紧组合列车组合定位方法 | |
CN104697485B (zh) | 基于单轴加速度传感器的姿态测量系统及其姿态测量方法 | |
CN108387227A (zh) | 机载分布式pos的多节点信息融合方法及系统 | |
CN106441372B (zh) | 一种基于偏振与重力信息的静基座粗对准方法 | |
CN102494699A (zh) | 捷联式航空重力仪测量参数置信度评估方法 | |
CN110440830A (zh) | 动基座下车载捷联惯导系统自对准方法 | |
CN106772488A (zh) | 一种航空重力测量gps后处理方法 | |
CN104049269A (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN106123917B (zh) | 考虑外杆臂效应的捷联惯导系统罗经对准方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN105928519B (zh) | 基于ins惯性导航与gps导航以及磁力计的导航算法 | |
CN108151765A (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
Vana et al. | Low-cost, dual-frequency PPP GNSS and MEMS-IMU integration performance in obstructed environments | |
RU109553U1 (ru) | Интегрированная система на основе бесплатформенной инерциальной навигационной системы и спутниковой навигационной системы | |
Ferguson et al. | Experiences with AIRGrav: Results from a new airborne gravimeter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |