CN105509768A - 一种单轴寻北仪的误差标定方法 - Google Patents

一种单轴寻北仪的误差标定方法 Download PDF

Info

Publication number
CN105509768A
CN105509768A CN201510850156.3A CN201510850156A CN105509768A CN 105509768 A CN105509768 A CN 105509768A CN 201510850156 A CN201510850156 A CN 201510850156A CN 105509768 A CN105509768 A CN 105509768A
Authority
CN
China
Prior art keywords
axle
single shaft
north finder
carrier system
error
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
CN201510850156.3A
Other languages
English (en)
Other versions
CN105509768B (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.)
China Aerospace Times Electronics Corp
Beijing Aerospace Control Instrument Institute
Original Assignee
China Aerospace Times Electronics Corp
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 China Aerospace Times Electronics Corp filed Critical China Aerospace Times Electronics Corp
Priority to CN201510850156.3A priority Critical patent/CN105509768B/zh
Publication of CN105509768A publication Critical patent/CN105509768A/zh
Application granted granted Critical
Publication of CN105509768B publication Critical patent/CN105509768B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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

Abstract

一种单轴寻北仪的误差标定方法,包括以下步骤:首先驱动转台进行四位置测试,标定出单轴寻北仪仪表系与载体系之间的控制偏角;然后以寻北仪仪表系为标定坐标系,控制转台进行相应的位置和速率测试;最后依据单轴寻北仪的误差模型完成各项误差系数的解算。本发明解决了单轴寻北仪载体系和仪表系不确定的角度关系问题,采用了简单的单轴寻北仪误差补偿模型及位置速率标定方法,实现了单轴寻北仪的误差标定。本发明的标定方法耗时少、计算简单,能够快速完成标定测试。

Description

一种单轴寻北仪的误差标定方法
技术领域
本发明提供了一种单轴寻北仪的误差标定方法,适用于利用单一陀螺和单一加速度计进行寻北的场合,属于惯性导航技术领域。
背景技术
单轴寻北仪是由单陀螺仪、单加速度计和相应的转动机构装置组成,陀螺仪和加速度计安装于寻北仪本体上,本体两端装有编码器及转动机构,由控制算法控制转动机构驱动本体进行多位置转动,再利用每个位置上的陀螺仪和加速度计的输出数据进行寻北解算。
单轴寻北仪是以本体仪表系为基准进行陀螺仪和加速度计数据采样,但对外输出的寻北结果为地理系,其中要经过仪表系、载体系和地理系三种坐标系的转换。传统的寻北仪是通过机械结构方式保证仪表系与载体系之间仅存在安装误差等小量误差,且可以通过传统标定方法获得。而对于没有机械结构限制的单轴寻北仪而言,仪表系和载体系之间只能依靠控制算法来确定两坐标系之间的位置关系。由于结构设计的限制,只能在安装时尽量保证仪表系与载体系之间的小角度,但该角度仍可能在几十度的范围内,因此无法再按照传统的方法进行标定,必须研究合理适用的标定方法。
另外,除了必须对两坐标系之间的角度偏差进行标定之外,还必须对寻北仪的系统误差进行标定,如仪表漂移误差、标度因数误差以及安装误差等。与传统的三陀螺和三加表的惯性导航系统不同,单轴寻北仪仅安装有单陀螺仪和单加速度计,无法按现有误差模型及标定方法进行标定及补偿,因此必须重新分析系统的误差特性,建立适用于单轴寻北仪的误差模型及误差标定方法。
因此,如何建立单轴寻北仪误差模型,解决带转动机构的单轴寻北仪的误差标定问题,是实现高精度寻北仪的基础。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供了一种单轴寻北仪的误差标定方法,提出了适用于单轴寻北仪的误差模型及误差标定方法,解决了带转动机构的单轴寻北仪的误差标定问题,实现了单轴寻北仪简单快速误差标定。
本发明的技术解决方案:
一种单轴寻北仪的误差标定方法,步骤如下:
(1)建立单轴寻北仪误差模型,确定要进行误差标定的参数;
(2)将单轴寻北仪安装在三轴转台上,单轴寻北仪载体系OXbYbZb以三轴转台内环轴、中环轴和外环轴为基准;
所述的单轴寻北仪载体系为OXbYbZb,其中坐标原点O位于寻北仪重心处,OYb轴沿寻北仪纵轴指向前,OXb轴沿寻北仪横轴指向右,OZb轴垂直于OXbYb,并沿寻北仪竖轴指向上;
(3)启动单轴寻北仪,控制单轴寻北仪仪表系OXYZ绕OZ轴转动,使OY轴锁定在零位,调节三轴转台使单轴寻北仪静置于四个不同位置;.
所述的单轴寻北仪仪表系为OXYZ,其中仪表系OZ轴与载体系OZb轴重合,OZ轴垂直于OXY,OY轴为仪表安装轴,OX轴与OY、OZ轴构成右手定则;
(4)在第k个位置时,k=1,2,3,4,采集单轴寻北仪中的陀螺仪经过Δt秒输出的脉冲数均值NPgy(k),并计算出单轴寻北仪仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ;
(5)调节三轴转台使单轴寻北仪分别进行十位置静置;
(6)在第i个位置时,i=1,2,3…10,分别采集陀螺仪和加速度计经过Δt秒输出的脉冲数累加和NJgy(i)和NJay(i);
(7)根据步骤(6)得到的陀螺仪和加速度计的十位置采样值,计算出单轴寻北仪加速度计的误差系数;
(8)调整三轴转台使单轴寻北仪按八阶段速率测试方法进行测试;
(9)在第j个测试阶段时,j=1,2,3…7,分别采集单轴寻北仪陀螺仪和加速度计经过Δt秒输出的脉冲累加和NVgy(j)和NVay(j);
(10)根据陀螺仪和加速度计输出的脉冲累加和NVgy(j)和NVay(j),计算出单轴寻北仪陀螺仪的误差系数,完成单轴寻北仪的误差标定。
所述的单轴寻北仪误差模型包括陀螺仪误差模型和加速度计误差模型:
陀螺仪误差模型为:
其中,ωy为陀螺仪角速率输出,Ngy为陀螺仪采样脉冲数,Kgy为陀螺仪标度因数,T为采样时间,D0y为陀螺仪零偏,Egzy为陀螺仪安装误差,ωie为地球自转角速率,为当地纬度值;Kgy、D0y和Egzy为需要标定的误差;
加速度计误差模型为:
N a y K a y T = K 0 y K a y + a y + E a z y · g ,
其中,ay为加速度计输出,Nay为加速度计采样脉冲数,Kay为加速度计标度因数,T为采样时间,K0y为加速度计零偏,Eazy为加速度计安装误差,g为当地重力加速度,Kay、K0y和Eazy为需要标定的误差。
所述步骤(3)中单轴寻北仪四位置分别为:
位置1:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于东北天方位;
位置2:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于北西天方位;
位置3:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于西南天方位;
位置4:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于南东天方位。
步骤(4)中单轴寻北仪仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ的计算方法为:
Δ φ = | arctan ( NP g y ( 2 ) - NP g y ( 4 ) NP g y ( 1 ) - NP g y ( 3 ) ) | × 180 / π ,
其中,Δφ为仪表系OXYZ的OY轴锁定于零位时与载体系OXbYbZb的OYb轴的零位偏角,取值范围为0°<Δφ<90°。
步骤(5)中单轴寻北仪十位置分别为:
第一位置1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置;
第二位置2:调节三轴转台先使单轴寻北仪载体系放置于东地北方位,再绕载体系-OZb轴转动Δφ角后静置;
第三位置3:调节三轴转台先使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后静置;
第四位置4:在第三位置3基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第五位置5:在第四位置4基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第六位置6:在第五位置5基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第七位置7:调节三轴转台先使单轴寻北仪载体系放置于西北地方位,再绕载体系-OZb轴转动Δφ角后静置;
第八位置8:在第七位置7基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第九位置9:在第八位置8基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第十位置10:在第九位置9基础上调节三轴转台绕载体系-OZb轴转动90°后静置。
所述的计算单轴寻北仪加速度计误差系数包括:加速度计零偏Koy、加速度计正标度因数负标度因数标度因数均值以及安装误差Eazy,具体计算方法为:
加速度计零偏 K 0 y = &Sigma; i = 3 i = 10 NJ a y ( i ) 8 &CenterDot; &Delta; t ,
加速度计正标度因数 K a y + = NJ a y ( 1 ) &Delta; t - K 0 y ,
加速度计负标度因数 K a y - = - NJ a y ( 2 ) &Delta; t + K 0 y ,
加速度计安装误差 E a z y = = &Sigma; i = 3 i = 6 NJ a y ( i ) - &Sigma; i = 7 i = 10 NJ a y ( i ) 4 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
步骤(8)中单轴寻北仪八阶段速率测试方法为:
阶段1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置采样;
阶段2:在完成阶段1基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段3:在完成阶段2基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段4:静置于阶段3再次采样;
阶段5:调节三轴转台使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后放置;
阶段6:在完成阶段5基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段7:在完成阶段6基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段8:静置于阶段7再次采样。
所述的计算单轴寻北仪陀螺误差系数包括:陀螺零偏D0y、陀螺正标度因数陀螺负标度因数以及安装误差Egzy,具体计算方法为:
陀螺正标度因数 K g y + = NV g y ( 3 ) - ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺负标度因数 K g y - = - NV g y ( 4 ) + ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺安装误差 E g z y = NV g y ( 6 ) - NV g y ( 7 ) 360 &CenterDot; 3600 &CenterDot; ( K g y + + K g y - ) ,
陀螺零偏 D 0 y = &Sigma; i = 1 i = 10 NJ g y ( i ) 5 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
所述的采样时间Δt取值范围为Δt≥60s。
本发明与现有技术相比的优点如下:
(1)本发明利用简单的四位置算法解算出仪表系和载体系之间的控制误差偏角,解决了无机械结构保证情况下的坐标转换问题,为标定出单轴寻北仪的误差系数奠定了基础;设计了独特的十位置和八阶段速率测试方法,配合先期标定出的仪表系和载体系的零位偏角,实现了基于仪表系的误差标定。相比现有技术,本发明巧妙地解决了单轴寻北仪载体系和仪表系不确定的角度关系问题,降低了寻北仪结构设计和机械加工的难度,同时测试方法简单可靠,完全能保证单轴寻北仪的误差标定精度。
(2)本发明中提出的单轴寻北仪误差模型,充分考虑了寻北仪单个陀螺和单个加速度计的各项误差源,不仅标定方法简单,而且能全面标定出系统所有误差模型系数;
(3)本发明的两次位置和一次速率测试方法,不仅耗时短、易于实现,而且误差系数的计算简单,能快速实现单轴寻北仪的误差标定。
附图说明
图1为本发明的方法流程图;
图2为本发明的单轴寻北仪三轴转台安装示意图;
图3为单轴寻北仪仪表系OXYZ与载体系OXbYbZb的关系示意图。
具体实施方式
单轴寻北仪主要由一个单轴陀螺仪、一个加速度计和相应的转动机构装置组成,针对单轴寻北仪的误差标定,实际上就是针对其中陀螺仪和加速度计的误差标定。
单轴寻北仪载体系定义为OXbYbZb,其中坐标原点O位于寻北仪重心处,OYb轴沿寻北仪纵轴指向前,OXb轴沿寻北仪横轴指向右,OZb轴垂直于OXbYb,并沿寻北仪竖轴指向上。
单轴寻北仪仪表系定义为OXYZ,其中仪表系OZ轴与载体系OZb轴重合,OZ轴垂直于OXY,OY轴为仪表安装轴,OX轴与OY、OZ轴构成右手定则。单轴寻北仪仪表系OXYZ与载体系OXbYbZb的关系见图3所示,由单轴寻北仪的结构设计可以将两坐标系的零位偏角Δφ限制在以载体系OXbYbZb为基准的逆时针90°范围内。
陀螺仪和加速度计均安装于仪表系OXYZ的OY轴上,转动机构安装于仪表系OXYZ的OZ轴两端,本体可以绕OZ轴旋转。
所述的单轴寻北仪误差模型包括陀螺仪误差模型和加速度计误差模型:
陀螺仪误差模型为:
其中,ωy为陀螺仪角速率输出,Ngy为陀螺仪采样脉冲数,Kgy为陀螺仪标度因数,T为采样时间,D0y为陀螺仪零偏,Egzy为陀螺仪安装误差,ωie为地球自转角速率,为当地纬度值。
加速度计误差模型为:
N a y K a y T = K 0 y K a y + a y + E a z y &CenterDot; g ,
其中,ay为加速度计输出,Nay为加速度计采样脉冲数,Kay为加速度计标度因数,T为采样时间,K0y为加速度计零偏,Eazy为加速度计安装误差,g为当地重力加速度。
如图1所示,本发明提供的一种单轴寻北仪的误差标定方法,步骤如下:
(1)建立单轴寻北仪误差模型,确定要进行误差标定的参数;
(2)将单轴寻北仪安装在三轴转台上,单轴寻北仪载体系OXbYbZb以三轴转台内环轴、中环轴和外环轴为基准。图2给出了单轴寻北仪的三轴转台安装示意图。所述的单轴寻北仪载体系为OXbYbZb,其中坐标原点O位于寻北仪重心处,OYb轴沿寻北仪纵轴指向前,OXb轴沿寻北仪横轴指向右,OZb轴垂直于OXbYb,并沿寻北仪竖轴指向上;
(3)启动寻北仪,控制单轴寻北仪仪表系OXYZ绕OZ轴转动,使OY轴锁定在零位。调节三轴转台使单轴寻北仪静置于四个不同位置,具体位置为:
位置1:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于东北天方位;
位置2:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于北西天方位;
位置3:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于西南天方位;
位置4:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于南东天方位;
所述的单轴寻北仪仪表系为OXYZ,其中仪表系OZ轴与载体系OZb轴重合,OZ轴垂直于OXY,OY轴为仪表安装轴,OX轴与OY、OZ轴构成右手定则;
(4)在第k个位置时(k=1,2,3,4),采集陀螺仪经过Δt秒输出的脉冲数均值NPgy(k),并计算出单轴寻北仪仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ,具体计算方法为:
&Delta; &phi; = | arctan ( NP g y ( 2 ) - NP g y ( 4 ) NP g y ( 1 ) - NP g y ( 3 ) ) | &times; 180 / &pi; ,
其中,Δφ为仪表系OXYZ的OY轴锁定于零位时与载体系OXbYbZb的OYb轴的零位偏角,取值范围为0°<Δφ<90°,采样时间Δt取值范围为Δt≥60s;
(5)调节三轴转台使单轴寻北仪进行十位置静置测试,具体位置为:
位置1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置;
位置2:调节三轴转台先使单轴寻北仪载体系放置于东地北方位,再绕载体系-OZb轴转动Δφ角后静置;
位置3:调节三轴转台先使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后静置;
位置4:在位置3基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
位置5:在位置4基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
位置6:在位置5基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
位置7:调节三轴转台先使单轴寻北仪载体系放置于西北地方位,再绕载体系-OZb轴转动Δφ角后静置;
位置8:在位置7基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
位置9:在位置8基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
位置10:在位置9基础上调节三轴转台绕载体系-OZb轴转动90°后静置。
(6)在第i个位置时(i=1,2,3…10),分别采集陀螺仪和加速度计经过Δt秒输出的脉冲数累加和NJgy(i)和NJay(i),采样时间Δt取值范围为Δt≥60s;
(7)根据十位置采样值,计算出单轴寻北仪加速度计的零偏、正负标度因数和安装误差,具体计算方法为:
加速度计零偏 K 0 y = &Sigma; i = 3 i = 10 NJ a y ( i ) 8 &CenterDot; &Delta; t ,
加速度计正标度因数 K a y + = NJ a y ( 1 ) &Delta; t - K 0 y ,
加速度计负标度因数 K a y - = - NJ a y ( 2 ) &Delta; t + K 0 y ,
加速度计安装误差 E a z y = = &Sigma; i = 3 i = 6 NJ a y ( i ) - &Sigma; i = 7 i = 10 NJ a y ( i ) 4 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
(8)调整三轴转台使单轴寻北仪按八阶段速率测试方法进行测试,具体速率测试方法为:
阶段1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置采样;
阶段2:在位置1基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段3:在位置2基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段4:静置于位置3再次采样;
阶段5:调节三轴转台使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后放置;
阶段6:在位置5基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段7:在位置6基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段8:静置于位置7再次采样。
(9)在第j个测试阶段时(j=1,2,3…7),分别采集单轴寻北仪陀螺仪和加速度计经过Δt秒输出的脉冲数NVgy(j)和NVay(j),采样时间Δt取值范围为Δt≥60s;
(10)根据速率测试数据,计算出单轴寻北仪陀螺仪的零漂、标度因数及安装误差,具体计算方法为:
陀螺正标度因数 K g y + = NV g y ( 3 ) - ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺负标度因数 K g y - = - NV g y ( 4 ) + ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺安装误差 E g z y = NV g y ( 6 ) - NV g y ( 7 ) 360 &CenterDot; 3600 &CenterDot; ( K g y + + K g y - ) ,
陀螺零偏 D 0 y = &Sigma; i = 1 i = 10 NJ g y ( i ) 5 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
到此,完成了单轴寻北仪误差标定。
实施例:
1).将单轴寻北仪安装于转台上,使载体系与转台各轴相重合。启动寻北仪控制单轴寻北仪仪表系OXYZ绕OZ轴转动,使OY轴锁定在零位。调节三轴转台使单轴寻北仪载体系OXbYbZb静置于4个不同位置,采样陀螺仪在Δt=60s的脉冲数均值,如表1所示。
表1四位置测试采样数据
并计算出仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ=23.441571°;
2).调节三轴转台使单轴寻北仪仪表系OXYZ静置于10个不同位置,分别采集陀螺仪和加速度计经过Δt=60s的脉冲数,如表2所示。
表2十位置测试采样数据
计算加速度计误差系数:
加速度计零偏:K0y=-4.11108E-02,
加速度计正标度因数:
加速度计负标度因数:
加速度计安装误差:Eazy=6.024198E-03。
2).调节三轴转台使单轴寻北仪仪表系OXYZ的OY轴分别朝天和朝地,并按照速率测试方法进行测试,分别采集陀螺仪和加速度计经过Δt=60s的脉冲数,如表3所示。
表3速率测试采样数据
计算陀螺误差系数:陀螺零偏D0y、陀螺正标度因数陀螺负标度因数以及安装误差Egzy,具体计算方法为:
陀螺正标度因数:
陀螺负标度因数:
陀螺安装误差:Egzy=-2.60004E-03,
陀螺零偏:D0y=0.079206。
经过实际工程的验证,本发明误差标定方法所标定的误差结果非常准确,完美解决了现有技术中存在的问题。

Claims (9)

1.一种单轴寻北仪的误差标定方法,其特征在于步骤如下:
(1)建立单轴寻北仪误差模型,确定要进行误差标定的参数;
(2)将单轴寻北仪安装在三轴转台上,单轴寻北仪载体系OXbYbZb以三轴转台内环轴、中环轴和外环轴为基准;
所述的单轴寻北仪载体系为OXbYbZb,其中坐标原点O位于寻北仪重心处,OYb轴沿寻北仪纵轴指向前,OXb轴沿寻北仪横轴指向右,OZb轴垂直于OXbYb,并沿寻北仪竖轴指向上;
(3)启动单轴寻北仪,控制单轴寻北仪仪表系OXYZ绕OZ轴转动,使OY轴锁定在零位,调节三轴转台使单轴寻北仪静置于四个不同位置;.
所述的单轴寻北仪仪表系为OXYZ,其中仪表系OZ轴与载体系OZb轴重合,OZ轴垂直于OXY,OY轴为仪表安装轴,OX轴与OY、OZ轴构成右手定则;
(4)在第k个位置时,k=1,2,3,4,采集单轴寻北仪中的陀螺仪经过Δt秒输出的脉冲数均值NPgy(k),并计算出单轴寻北仪仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ;
(5)调节三轴转台使单轴寻北仪分别进行十位置静置;
(6)在第i个位置时,i=1,2,3…10,分别采集陀螺仪和加速度计经过Δt秒输出的脉冲数累加和NJgy(i)和NJay(i);
(7)根据步骤(6)得到的陀螺仪和加速度计的十位置采样值,计算出单轴寻北仪加速度计的误差系数;
(8)调整三轴转台使单轴寻北仪按八阶段速率测试方法进行测试;
(9)在第j个测试阶段时,j=1,2,3…7,分别采集单轴寻北仪陀螺仪和加速度计经过Δt秒输出的脉冲累加和NVgy(j)和NVay(j);
(10)根据陀螺仪和加速度计输出的脉冲累加和NVgy(j)和NVay(j),计算出单轴寻北仪陀螺仪的误差系数,完成单轴寻北仪的误差标定。
2.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:所述的单轴寻北仪误差模型包括陀螺仪误差模型和加速度计误差模型:
陀螺仪误差模型为:
其中,ωy为陀螺仪角速率输出,Ngy为陀螺仪采样脉冲数,Kgy为陀螺仪标度因数,T为采样时间,D0y为陀螺仪零偏,Egzy为陀螺仪安装误差,ωie为地球自转角速率,为当地纬度值;Kgy、D0y和Egzy为需要标定的误差;
加速度计误差模型为:
N a y K a y T = K 0 y K a y + a y + E a z y &CenterDot; g ,
其中,ay为加速度计输出,Nay为加速度计采样脉冲数,Kay为加速度计标度因数,T为采样时间,K0y为加速度计零偏,Eazy为加速度计安装误差,g为当地重力加速度,Kay、K0y和Eazy为需要标定的误差。
3.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:所述步骤(3)中单轴寻北仪四位置分别为:
位置1:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于东北天方位;
位置2:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于北西天方位;
位置3:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于西南天方位;
位置4:调节三轴转台使单轴寻北仪载体系OXbYbZb静置于南东天方位。
4.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:步骤(4)中单轴寻北仪仪表系OXYZ与载体系OXbYbZb的零位偏角Δφ的计算方法为:
&Delta; &phi; = | a r c t a n ( NP g y ( 2 ) - NP g y ( 4 ) NP g y ( 1 ) - NP g y ( 3 ) ) | &times; 180 / &pi; ,
其中,Δφ为仪表系OXYZ的OY轴锁定于零位时与载体系OXbYbZb的OYb轴的零位偏角,取值范围为0°<Δφ<90°。
5.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:步骤(5)中单轴寻北仪十位置分别为:
第一位置1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置;
第二位置2:调节三轴转台先使单轴寻北仪载体系放置于东地北方位,再绕载体系-OZb轴转动Δφ角后静置;
第三位置3:调节三轴转台先使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后静置;
第四位置4:在第三位置3基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第五位置5:在第四位置4基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第六位置6:在第五位置5基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第七位置7:调节三轴转台先使单轴寻北仪载体系放置于西北地方位,再绕载体系-OZb轴转动Δφ角后静置;
第八位置8:在第七位置7基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第九位置9:在第八位置8基础上调节三轴转台绕载体系-OZb轴转动90°后静置;
第十位置10:在第九位置9基础上调节三轴转台绕载体系-OZb轴转动90°后静置。
6.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:所述的计算单轴寻北仪加速度计误差系数包括:加速度计零偏Koy、加速度计正标度因数负标度因数标度因数均值以及安装误差Eazy,具体计算方法为:
加速度计零偏 K 0 y = &Sigma; i = 3 i = 10 NJ a y ( i ) 8 &CenterDot; &Delta; t ,
加速度计正标度因数 K a y + = NJ a y ( 1 ) &Delta; t - K 0 y ,
加速度计负标度因数 K a y - = - NJ a y ( 2 ) &Delta; t + K 0 y ,
加速度计安装误差 E a z y = = &Sigma; i = 3 i = 6 NJ a y ( i ) - &Sigma; i = 7 i = 10 NJ a y ( i ) 4 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
7.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:步骤(8)中单轴寻北仪八阶段速率测试方法为:
阶段1:调节三轴转台先使单轴寻北仪载体系放置于东天南方位,再绕载体系-OZb轴转动Δφ角后静置采样;
阶段2:在完成阶段1基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段3:在完成阶段2基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段4:静置于阶段3再次采样;
阶段5:调节三轴转台使单轴寻北仪载体系放置于东北天方位,再绕载体系-OZb轴转动Δφ角后放置;
阶段6:在完成阶段5基础上,绕转台外环轴匀速正转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段7:在完成阶段6基础上,绕转台外环轴匀速反转360°,转动过程时间应小于Δt,并确保在转动前后均能采样到静止数据;
阶段8:静置于阶段7再次采样。
8.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:所述的计算单轴寻北仪陀螺误差系数包括:陀螺零偏D0y、陀螺正标度因数陀螺负标度因数以及安装误差Egzy,具体计算方法为:
陀螺正标度因数 K g y + = NV g y ( 3 ) - ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺负标度因数 K g y - = - NV g y ( 4 ) + ( NV g y ( 1 ) + NV g y ( 4 ) ) / 2.0 360 &CenterDot; 3600 ,
陀螺安装误差 E g z y = NV g y ( 6 ) - NV g y ( 7 ) 360 &CenterDot; 3600 &CenterDot; ( K g y + + K g y - ) ,
陀螺零偏 D 0 y = &Sigma; i = 1 i = 10 NJ g y ( i ) 5 &CenterDot; &Delta; t &CenterDot; ( K g y + + K g y - ) .
9.根据权利要求1所述的一种单轴寻北仪的误差标定方法,其特征在于:所述的采样时间Δt取值范围为Δt≥60s。
CN201510850156.3A 2015-11-27 2015-11-27 一种单轴寻北仪的误差标定方法 Active CN105509768B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510850156.3A CN105509768B (zh) 2015-11-27 2015-11-27 一种单轴寻北仪的误差标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510850156.3A CN105509768B (zh) 2015-11-27 2015-11-27 一种单轴寻北仪的误差标定方法

Publications (2)

Publication Number Publication Date
CN105509768A true CN105509768A (zh) 2016-04-20
CN105509768B CN105509768B (zh) 2018-05-22

Family

ID=55717922

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510850156.3A Active CN105509768B (zh) 2015-11-27 2015-11-27 一种单轴寻北仪的误差标定方法

Country Status (1)

Country Link
CN (1) CN105509768B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN107421564A (zh) * 2017-06-23 2017-12-01 北京机械设备研究所 一种四位置寻北仪转位误差补偿方法
CN109471459A (zh) * 2018-11-08 2019-03-15 中国船舶重工集团公司第七0七研究所 一种采用分步积分pi算法的寻北仪转位控制装置及方法
CN110006450A (zh) * 2019-04-15 2019-07-12 哈尔滨工业大学 一种激光捷联惯导系统在卧式三轴转台上的标定方法
CN110849342A (zh) * 2019-11-20 2020-02-28 中国船舶重工集团公司第七0七研究所 一种寻北误差补偿方法
CN111664868A (zh) * 2020-05-28 2020-09-15 北京航天时代光电科技有限公司 一种单轴陀螺安装误差标定与补偿的方法
CN112504256A (zh) * 2020-11-19 2021-03-16 北京航天发射技术研究所 一种高精度低成本异构型激光陀螺寻北仪
CN114459465A (zh) * 2021-03-02 2022-05-10 北京天兵科技有限公司 一种mems惯组方位的在线补偿方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4807138A (en) * 1985-11-22 1989-02-21 Bodenseewerk Geratetechnik Gmbh Device for determining the north direction
CN102735231A (zh) * 2012-06-21 2012-10-17 浙江大学 一种提高光纤陀螺寻北仪精度的方法
CN103697878A (zh) * 2013-12-16 2014-04-02 北京自动化控制设备研究所 一种单陀螺单加速度计旋转调制寻北方法
CN103743413A (zh) * 2013-12-27 2014-04-23 哈尔滨工程大学 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4807138A (en) * 1985-11-22 1989-02-21 Bodenseewerk Geratetechnik Gmbh Device for determining the north direction
CN102735231A (zh) * 2012-06-21 2012-10-17 浙江大学 一种提高光纤陀螺寻北仪精度的方法
CN103697878A (zh) * 2013-12-16 2014-04-02 北京自动化控制设备研究所 一种单陀螺单加速度计旋转调制寻北方法
CN103743413A (zh) * 2013-12-27 2014-04-23 哈尔滨工程大学 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
纪文涛 等,: ""激光陀螺四位置寻北仪提高精度方法"", 《导航与控制》 *
谢慕君 等,: ""基于动调陀螺的多位置寻北仪的转位误差分析"", 《光电工程》 *

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN106017507B (zh) * 2016-05-13 2019-01-08 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN107421564A (zh) * 2017-06-23 2017-12-01 北京机械设备研究所 一种四位置寻北仪转位误差补偿方法
CN107421564B (zh) * 2017-06-23 2019-08-02 北京机械设备研究所 一种四位置寻北仪转位误差补偿方法
CN109471459A (zh) * 2018-11-08 2019-03-15 中国船舶重工集团公司第七0七研究所 一种采用分步积分pi算法的寻北仪转位控制装置及方法
CN109471459B (zh) * 2018-11-08 2021-07-23 中国船舶重工集团公司第七0七研究所 一种采用分步积分pi算法的寻北仪转位控制装置及方法
CN110006450B (zh) * 2019-04-15 2021-06-08 哈尔滨工业大学 一种激光捷联惯导系统在卧式三轴转台上的标定方法
CN110006450A (zh) * 2019-04-15 2019-07-12 哈尔滨工业大学 一种激光捷联惯导系统在卧式三轴转台上的标定方法
CN110849342A (zh) * 2019-11-20 2020-02-28 中国船舶重工集团公司第七0七研究所 一种寻北误差补偿方法
CN110849342B (zh) * 2019-11-20 2022-06-10 中国船舶重工集团公司第七0七研究所 一种寻北误差补偿方法
CN111664868A (zh) * 2020-05-28 2020-09-15 北京航天时代光电科技有限公司 一种单轴陀螺安装误差标定与补偿的方法
CN112504256A (zh) * 2020-11-19 2021-03-16 北京航天发射技术研究所 一种高精度低成本异构型激光陀螺寻北仪
CN114459465A (zh) * 2021-03-02 2022-05-10 北京天兵科技有限公司 一种mems惯组方位的在线补偿方法
CN114459465B (zh) * 2021-03-02 2023-08-22 北京天兵科技有限公司 一种mems惯组方位的在线补偿方法

Also Published As

Publication number Publication date
CN105509768B (zh) 2018-05-22

Similar Documents

Publication Publication Date Title
CN105509768A (zh) 一种单轴寻北仪的误差标定方法
CN110160554B (zh) 一种基于寻优法的单轴旋转捷联惯导系统标定方法
CN1330935C (zh) 安装误差角与标度因数解耦的微惯性测量单元精确标定方法
CN103808331B (zh) 一种mems三轴陀螺仪误差标定方法
CN100565115C (zh) 多位置捷联寻北系统方位效应的标定方法
CN104344837B (zh) 一种基于速度观测的冗余惯导系统加速度计系统级标定方法
CN103090867B (zh) 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法
CN106969783B (zh) 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术
CN104344836B (zh) 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法
CN102564452B (zh) 一种基于惯性导航系统的在线自主标定方法
CN103900608B (zh) 一种基于四元数ckf的低精度惯导初始对准方法
CN102735231B (zh) 一种提高光纤陀螺寻北仪精度的方法
CN101706287B (zh) 一种基于数字高通滤波的旋转捷联系统现场标定方法
CN101571394A (zh) 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法
CN109974697A (zh) 一种基于惯性系统的高精度测绘方法
CN105628025B (zh) 一种恒速偏频/机抖激光陀螺惯导系统导航方法
CN103076025B (zh) 一种基于双解算程序的光纤陀螺常值误差标定方法
CN102393210A (zh) 一种激光陀螺惯性测量单元的温度标定方法
CN106017507A (zh) 一种用于中低精度的光纤惯组快速标定方法
CN110361031B (zh) 一种基于回溯理论的imu全参数误差快速标定方法
CN104634364B (zh) 一种基于阶梯波调制的光纤陀螺标度因数的自标定方法
CN104596543B (zh) 一种基准不确定情况下陀螺仪组合误差系数标定方法
CN103900607B (zh) 一种基于惯性系的旋转式捷联惯导系统转位方法
CN106767915A (zh) 一种运载火箭带冗余斜轴的光纤惯组标定方法
CN103983276A (zh) 一种基于导航基准系的三框架四轴惯性平台误差标定方法

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