CN102927994B - 一种斜置冗余捷联惯性导航***的快速标定方法 - Google Patents
一种斜置冗余捷联惯性导航***的快速标定方法 Download PDFInfo
- Publication number
- CN102927994B CN102927994B CN201210404851.3A CN201210404851A CN102927994B CN 102927994 B CN102927994 B CN 102927994B CN 201210404851 A CN201210404851 A CN 201210404851A CN 102927994 B CN102927994 B CN 102927994B
- Authority
- CN
- China
- Prior art keywords
- centerdot
- sky
- gyroscope
- accelerometer
- rsins
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种斜置冗余捷联惯导***快速标定方法,包括步骤一:描述斜置RSINS安装失准角,给出标定量测方程。步骤二:设计斜置RSINS标定方案。步骤三:搭建斜置RSINS标定仿真平台,并利用仿真平台验证标定方法的准确性。本发明基于三轴位置/速率转台对斜置RSINS进行快速标定,分别利用四位置法和三位置转动法标定冗余加速度计及陀螺仪的零偏、标度因数及安装失准角等标定参数,并利用仿真平台验证以上标定方法的准确性。本发明标定精度高,操作简便,可以满足中、低精度斜置RSINS的快速标定需求,具有较好的工程应用价值。
Description
技术领域
本发明涉及一种斜置冗余捷联惯性导航***的快速标定方法,属于航空、航天导航技术领域。
背景技术
传统的捷联惯导***方案为“3陀螺+3加速度计”正交配置,利用陀螺与加速度计的敏感轴构建惯导***的本体坐标系。在惯导解算过程中将利用陀螺与加速度计的全部输出信息。传统的捷联式惯导***不允许惯性敏感元件产生故障输出,当任意惯性敏感元件发生故障输出异常值时,***输出的导航结果将不再有效。因此传统的捷联惯导***中任意惯性器件的故障等同于整套***的报废,引起的后果将不堪设想。惯导***的精度和可靠性很大程度上取决于惯性敏感元件的精度及可靠性。提高惯性敏感元件的精度和可靠性需要整个工业及制造业水平的提高,这需要很长的研发周期并且投入巨大的财力。在现有工业生产水平条件下,采用冗余设计是提高惯导***可靠性的有效途径。
冗余技术可分为***级冗余及器件级冗余两种。***级冗余指一套或多套***作为备份,当主***失效时备份***开始工作;器件级冗余指利用多个惯性敏感元件的最佳配置来构成冗余***,当一个或多个器件失效时冗余器件仍可完成导航任务。平台式惯导***机械结构较为复杂,均采取***级冗余策略。与平台式***相比,捷联式惯导***体积较小,惯性敏感元件灵活地与载体固联,无需使用复杂的机械支承及稳定平台,因此器件级冗余技术更适用于捷联式惯导***。冗余技术已成为提高捷联惯导***(SINS)可靠性及精度的重要方法之一。相比较***级冗余,器件级斜置冗余方式在体积功耗及成本方面具有较大优势,成为冗余捷联惯导***(RSINS)的首选。斜置RSINS在使用前必须对传感器进行准确标定,以确定各惯性传感器的零偏、标度因数及安装失准角等参数。
传统正交型SINS主要有分立式和***级两种标定方法:分立标定法直接利用陀螺仪和加速度计的输出作为观测量,一般采用最小二乘法;***级标定则利用陀螺仪和加速度计的输出进行导航解算,以导航误差(位置误差、速度误差及姿态误差)作为观测量来标定***的误差参数。由于斜置RSINS传感器采用非正交安装方式,其标定方法有别于传统正交型SINS。
现有的冗余捷联惯导***标定时有着如下不足之处:
1、现有国内分立式标定方法仅适用于精度较低的MEMS器件组成的冗余捷联惯导***,通用性较差;
2、对目前国内惯性器件水平而言,尚不能完全发挥***级标定的优势,若Kalman滤波器设计不恰当,各标定参数估值将发散,严重影响标定性能。
发明内容
本发明的目的是为了解决上述问题,提出一种斜置冗余捷联惯性导航***的快速标定方法,分别利用四位置法和三位置转动法标定冗余加速度计及陀螺仪的零偏、标度因数及安装失准角等标定参数,并且利用仿真平台验证本发明标定方法的准确性。本发明标定精度高,操作简便,具有较好的工程应用价值,应用于惯性传感器零偏、标度因数及安装失准角等参数的辨识中,可以有效地辨识出参数,具有很高的标定精度。
一种斜置冗余捷联惯性导航***的快速标定方法,包括以下几个步骤:
步骤一:描述斜置RSINS安装失准角,构建标定量测方程;
(1)斜置RSINS安装失准角描述;
(2)构建斜置RSINS标定量测方程;
步骤二:确定斜置RSINS标定方案,包括确定三轴转台位置,加速度计四位置标定方法,确定陀螺仪标定方法,采用陀螺仪四位置标定方法或陀螺仪三位置转动标定方法;
步骤三:搭建斜置RSINS标定仿真平台,并利用仿真平台验证所述的标定方法的准确性。
本发明的优点在于:
(1)本发明所述方法适用于多种精度的斜置RINS的标定,具有通用性;
(2)本发明所述方法标定精度较高,操作简单且耗时短,可以满足中、低精度斜置RSINS的快速标定需求;
(3)本发明所述方法对于中低精度陀螺仪,三位置转动标定方法有效增强了陀螺仪标定参数可观测性。
附图说明
图1是本发明理想传感器轴向与***本体坐标系的安装关系;
图2是本发明实际传感器轴向与***本体坐标系的安装关系;
图3是本发明标定仿真平台结构框图;
图4是本发明六冗余RSINS的正十二面体安装方式;
图5是本发明的方法流程图。
图中:
1—斜置RSINS配置方式选择模块 2—IMU数据构造模块 3—标定参数选择模块
4—转台位置和速率选择模块 5—标定参数解算模块 6—标定结果验证模块
具体实施方式
下面将结合附图和实施例对本发明作进一步的详细说明。
本发明是一种斜置冗余捷联惯性导航***的快速标定方法,首先给出了斜置RSINS(斜置冗余捷联惯性导航***)的标定量测方程并着重描述了其安装失准角;然后给出了加速度计和陀螺仪的四位置标定方法,并针对低精度陀螺仪提出了三位置转动标定方法;最后搭建斜置RSINS标定仿真平台,描述各功能模块作用,并利用仿真平台验证以上标定方法的准确性。
流程如图5所示,包括以下几个步骤:
步骤一:描述斜置RSINS安装失准角,构建标定量测方程。
(1)斜置RSINS安装失准角描述
在斜置RSINS中,传感器坐标系(s系)并非三轴正交的笛卡尔坐标系,因此必须将传感器输出映射至***本体固连坐标系(b系),以完成常规惯导解算。如图1所示OXbYbZb为***本体固连坐标系;Hi表示第i个传感器的轴向,Hi与b系具有如下映射关系:
hi=[cos(αi)cos(βi)]·i+[sin(αi)cos(βi)]·j+[sin(βi)]·k (1)
其中:hi、i、j、k分别表示Hi轴、Xb轴、Yb轴、Zb轴上的单位矢量,αi表示hi在Xb-Yb平面上的投影向量与Xb轴的夹角,βi表示hi与Xb-Yb平面的夹角。
但传感器实际安装过程中,不可能保证真实传感器轴Hi'与理想轴Hi严格重合,假设两者具有小角度误差δαi和δβi,如图2所示。假设传感器轴Hi'在Xb-Yb平面上的投影向量与Xb轴的夹角为αi',与Xb-Yb平面的夹角为βi',因此:
hi'=[cos(αi')cos(βi')]·i+[sin(αi′)cos(βi')]·j+[sin(βi′)]·k (2)
将αi'=αi-δαi及βi'=βi+δβi代入式(2),忽略二阶小量(δαi·δβi),并将sin(δαi)、sin(δβi)线性化为δαi、δβi,cos(δαi)、cos(δβi)近似为1,可得到式(3):
hi'=hi+δαi·pi+δβi·qi (3)
式中,pi=[sin(αi)cos(βi)-cos(αi)cos(βi)0],qi=[-cos(αi)sin(βi)-sin(αi)sin(βi)cos(βi)]。
(2)构建斜置RSINS标定量测方程
在实际使用过程中,斜置RSINS中的陀螺仪与加速度计输出并非角速度与加速度真值,而是与之相关的脉冲数或数字量,器件输出值必须经过标定补偿后才可使用。标定参数主要包括零偏、标度因数及安装失准角三项。假设***中惯性传感器输出表示为M=[m1,m2,…,mi,…mn]T,其中,mi表示第i个(i∈[1,n])陀螺仪或加速度计输出的原始脉冲量,n表示***冗余度(即陀螺或加速度计的数量);***本体坐标系敏感到的角速度或加速度表示为X=[xx xy xz]T,对于陀螺仪而言X表示角速度矢量,而对于加速度计而言X表示加速度矢量,xx xy xz分别表示X沿着***本体坐标系的分量;H=[h1,h2,…,hi,…hn]T表示***理想安装矩阵,其中,hi描述第i个(i∈[1,n])陀螺仪或加速度计相对于***本体坐标系的理想安装方向矢量;H'=[h1',h2',…,hi',…hn']T表示***实际安装矩阵,其中,hi'描述第i个(i∈[1,n])陀螺仪或加速度计相对于***本体坐标系的实际安装方向矢量,H'=H+δα·P+δβ·Q;B=[b1 b2…bn]T表示n个传感器的零偏矢量;K=diag[k1 k2…kn]表示由n个传感器的标度因数组成的对角阵,另有:
δα=diag[δα1,δα2,…,δαi,…,δαn];
δβ=diag[δβ1,δβ2,…,δβi,…,δβn];
P=[p1,p2,…,pi,…,pn]T;
Q=[q1,q2,…,qi,…,qn]T;
其中:此时K、P、Q、δα、δβ、H、H'和B均为常值,斜置RSINS标定量测方程具体为:
M=K(H+δα·P+δβ·Q)·X+B (4)
步骤二:确定斜置RSINS标定方案,包括确定三轴转台位置,加速度计四位置标定方法,确定陀螺仪标定方法,采用陀螺仪四位置标定方法或陀螺仪三位置转动标定方法。
假设只考虑其中某一个传感器的标定量测方程,如下所示:
mi=ki(hi+δαi·pi+δβi·qi)·x+bi (5)
其中:mi、bi、ki分别表示第i个陀螺仪或加速度计的输出原始脉冲、零偏误差以及标度因数。。
式(5)写为如下形式:
其中::hi1、hi2、hi3分别表示矢量hi中的第一个、第二个、第三个元素,pi1、pi2、pi3分别表示矢量pi中的第一个、第二个、第三个元素,qi1、qi2、qi3分别表示矢量qi中的第一个、第二个、第三个元素,x是转台的输入值或者地球转速、地球重力加速度值,即为参考标准量。
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2(k=0,±1,±2…),则有:
将RSINS放置于l个不同位置,使得地球转速ωie/重力加速度g在***本体坐标系的投影向量x均不同,且传感器输出值不全为O,若***观测矩阵满足如下条件,则ki,δαi和δβi具有唯一解:
xl是指l个不同位置下的x值;
(1)确定三轴转台位置
假设在初始状态三轴转台的外框轴沿东-西向,中框轴沿南-北向,内框轴沿天-地向,斜置RSINS***本体坐标系沿东-北-天方向。此时三轴位置/速率转台可到达的24个位置如表1所示。
表1三轴转台可转到的24个位置
Z:g表示:此时***本体坐标系的z轴朝天,当地重力加速度在z轴上分量为g(g约为9.8m/s2,在不同的地理位置有所不同,以下g定义相同);
Z:-g表示:此时***本体坐标系的z轴朝地,当地重力加速度在z轴上分量为-g;
X:g、X:-g、Y:g、Y:-g与以上Z轴定义方式相同。
(2)加速度计四位置标定方法
加速度计标定时观测量为当地重力加速度,其在垂直方向上分量为g或-g,在水平方向分量为0。将RSINS本体坐标系的三个轴分别朝天和地,转台可到达的24个位置可分为6组,如表1所示。加速度计可利用表1所示的24位置中的至少4个位置进行标定。假设***初始位置位于东北天,第二位置转至东南地,两位置输出数据取均值即可标定出加速度计零偏;再在y轴位于天、地方向的8个位置中挑选任一位置,x轴位于天地方向的8位置中挑选任一位置,即可标定加速度计标度因数及安装失准角。对于任意一个加速度计,挑选东北天、东南地、东天南、天西南四个位置,采集某段数据后求均值可得:
1、东北天:
mi1=ki(hi+δαi·pi+δβi·qi)·[0 0 g]T+bi
2、东南地:
mi2=ki(hi+δαi·pi+δβi·qi)·[0 0 -g]T+bi
3、东天南:
mi3=ki(hi+δαi·pi+δβi·qi)·[0 g 0]T+bi
4、天西南:
mi4=ki(hi+δαi·pi+δβi·qi)·[g 0 0]T+bi
其中:mi1至mi4分别表示四个位置的加速度计输出原始脉冲量,因此加速度计零偏可表示为:
bi=(mi1+mi2)/2 (9)
利用以上四个位置数据可构建如下方程:
式中:
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2(k=0,±1,±2…),则有:
rank(Λ)=3 (11)
因此加速度计的标度因数及安装失准角可通过方程(10)获得唯一解。
(3)确定陀螺仪标定方法,采用采用陀螺仪四位置标定方法或者陀螺仪三位置转动标定方法,若仅以地球转速ωie作为观测量,当陀螺仪精度较高(零偏稳定性约为0.01°/h量级)时,采用陀螺仪四位置标定方法,其余,采用陀螺仪三位置转动标定方法,具体为:
1)陀螺仪四位置标定方法
地球自转角速度ωie在当地地理坐标系(东-北-天坐标系)中的投影矢量为ωie=[0 ωn ωu]T,其中ωn=ωie·cos(L)、ωu=ωie·sin(L),L为当地地理纬度。取与(2)中加速度计标定时相同的四个位置,采集任意一个陀螺仪的某段数据后求均值可得:
1、东北天:
mi1=ki(hi+δαi·pi+δβi·qi)·[0 ωn ωu]T+bi
2、东南地:
mi2=ki(hi+δαi·pi+δβi·qi)·[0 -ωn -ωu]T+bi
3、东天南:
mi3=ki(hi+δαi·pi+δβi·qi)·[0 ωu -ωn]T+bi
4、天西南:
mi4=ki(hi+δαi·pi+δβi·qi)·[ωu 0 -ωn]T+bi
因此陀螺仪零偏可表示为:
bi=(mi1+mi2)/2 (12)
利用以上四个位置数据可构建如下方程:
式中:
其中,L表示当地地理纬度。
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2(k=0,±1,±2…),可得如下结论:
rank(Г)=3 (14)
通过方程(13)即可得到陀螺仪标度因数及安装失准角。
2)陀螺仪三位置转动标定方法
若仅以地球转速ωie作为观测量,对于中低精度陀螺仪而言,其零偏与噪声即可将地球转速淹没,此时四位置简易标定方法不再适用,必须对转台施加较大转速以提高标定参数的可观测性。
将***本体的Xb轴朝东以ω的转速正向转动,在t1时刻Yb轴与北向夹角为θ,假设经过时间t***旋转n周(n=1,2,3,…),即转过角度为2π·n(n=1,2,3,…)。将时间t内Yb与Zb轴敏感的所有角速度分别积分可得:
ωn=ωie·cos(L)、ωu=ωie·sin(L),L为当地地理纬度。另外两轴朝东转动时可得到同样的结论。因此陀螺仪可用三位置转动标定方法进行标定,步骤如下:
1、首先将***置于东北天和东南地并采集数据求取陀螺零偏并补偿;
2、将***本体坐标轴Xb、Yb和Zb分别朝东,且以角速度ω匀速转动整数周l,累加补偿零偏后的所有陀螺输出值,可得到下式:
如式(7)所示,矩阵Λ为满秩矩阵,因此解方程(16)即可得到陀螺仪的标度因数及安装失准角参数。
标定是器件参数辨识的一种方法,器件输出信号均为脉冲量,原始输出脉冲量并不能被惯性导航***直接使用,必须经过以下处理:
实际使用量=安装失准角矩阵*{(原始脉冲量-固有零偏值)/器件标度因数}
安装失准角、固有零偏值、标度因数三种参数不是已知的,必须通过标定的方式将三种参数求解,再补偿进上式中得到实际使用量。因此本发明提出的标定方法具体应用场合/背景就是冗余型光纤陀螺捷联惯性导航***。
步骤三:搭建斜置RSINS标定仿真平台,并利用仿真平台验证所述的标定方法的准确性。
(1)搭建标定仿真平台
如图3所示,标定仿真平台包括斜置RSINS配置方式选择模块1、IMU数据构造模块2、标定参数选择模块3、转台位置和速率选择模块4、标定参数解算模块5和标定结果验证模块6。
斜置RSINS配置方式选择模块1选择如正四面体、正八面体、正十二面体等不同配置方式下的四、五、六斜置冗余RSINS。
IMU数据构造模块2产生已选择的斜置RSINS中冗余IMU数据,包含全部陀螺仪与加速度计原始脉冲数据,单位分别为°/s和m/s2;。
标定参数选择模块3选择标定参数,主要包含零偏、标度因数、安装失准角,利用以上参数并叠加器件噪声,即可构建冗余陀螺仪与加速度计的原始数据。
转台位置和速率选择模块4选择转台可转到的24个不同位置,并结合多种正、反转速率,产生转台不同位置、速率下的冗余陀螺仪与加速度计原始数据,此模块主要用于产生标定过程数据,用于直接求解各项标定参数。
标定参数解算模块5主要利用步骤一和步骤二中描述的标定参数解算方法推算冗余器件零偏、标度因数及安装失准角的大小,并与预设值进行比较。
标定结果验证模块6利用以上标定结果,结合轨迹发生器进行***初始对准及惯性导航性能验证。
(2)确定仿真条件
斜置RSINS***结构如图4所示,***包含6个冗余陀螺仪与加速度计,分别沿正12面体中6个平面的法线方向配置,这种配置方式具有几何对称性。图4中XYZ为***本体坐标系,M1、M2和M3为由本体坐标系三个坐标轴组成的互垂直面,传感器轴以ABCDEF表示(AB位于面M2,CD位于面M 1,EF位于面M3),所夹空间角为2α=63°26′5.8″。
根据图4的配置方式,可得到***的安装矩阵为:
假设采用性能相同的冗余陀螺仪与加速度计,零偏、标度及安装失准角均相同。仿真过程中采样周期为20ms,各项标定参数如表2所示。
表2冗余陀螺仪与加速度计标定参数
(3)仿真过程及结果
标定仿真平台中选择转台位置为东北天、东南地、东天南、天西南四个位置,分别采集RSINS输出的5min冗余加速度计数据用于四位置标定;同时将RSINS***的本体坐标系的三个坐标轴分别朝东以20°/s转速转动,采集5min数据用于陀螺仪的三位置转动标定。
表3冗余加速度计四位置法标定结果
表4冗余陀螺仪三位置转动法标定结果
对比表3、表4与表2的数据可知,此方法可较为准确地标定斜置RSINS的零偏、标度因数及安装失准角,整个标定过程小于1h且操作简单,因此整个标定方法可兼顾快速性及准确性。
Claims (2)
1.一种斜置冗余捷联惯性导航***的快速标定方法,其特征在于,包括以下几个步骤:
步骤一:描述斜置RSINS安装失准角,构建标定量测方程;
(1)斜置RSINS安装失准角描述
RSINS表示冗余捷联惯导***,在斜置RSINS中,传感器坐标系为s系,***本体固连坐标系为b系,OXbYbZb表示***本体固连坐标系,Hi表示第i个传感器的轴向,Hi与b系具有如下映射关系:
hi=[cos(αi)cos(βi)]·i+[sin(αi)cos(βi)]·j+[sin(βi)]·k (1)
其中:hi、i、j、k分别表示Hi轴、Xb轴、Yb轴、Zb轴上的单位矢量,αi表示hi在Xb-Yb平面上的投影向量与Xb轴的夹角,βi表示hi与Xb-Yb平面的夹角;
在传感器实际应用中,设传感器的真实轴Hi'与传感器的理想轴Hi具有误差δαi和δβi,假设传感器轴Hi'在Xb-Yb平面上的投影向量与Xb轴的夹角为αi',与Xb-Yb平面的夹角为βi',因此:
hi'=[cos(αi')cos(βi')]·i+[sin(αi')cos(βi')]·j+[sin(βi')]·k (2)
将αi'=αi-δαi及βi'=βi+δβi代入式(2),忽略二阶小量(δαi·δβi),并将sin(δαi)、sin(δβi)线性化为δαi、δβi,cos(δαi)、cos(δβi)近似为1,得到式(3):
hi'=hi+δαi·pi+δβi·qi (3)
式中,pi=[sin(αi)cos(βi)-cos(αi)cos(βi)0],qi=[-cos(αi)sin(βi)-sin(αi)sin(βi)cos(βi)];
(2)构建斜置RSINS标定量测方程
斜置RSINS标定量测方程具体为:
M=K(H+δα·P+δβ·Q)·X+B (4)
其中:M为斜置RSINS***中惯性传感器的输出,可表示为:
M=[m1,m2,…,mi,…mn]T
式中,mi表示第i个陀螺仪或加速度计输出的原始脉冲量,i∈[1,n],n表示***冗余度,即陀螺或加速度计的数量;
K=diag[k1 k2 … kn]表示由n个传感器的标度因数组成的对角阵;
H=[h1,h2,…,hi,…hn]T表示***理想安装矩阵,其中,hi描述第i个陀螺仪或加速度计相对于***本体坐标系的理想安装方向矢量;
δα=diag[δα1,δα2,…,δαi,…,δαn];
δβ=diag[δβ1,δβ2,…,δβi,…,δβn];
P=[p1,p2,…,pi,…,pn]T;
Q=[q1,q2,…,qi,…,qn]T;
X=[xx xy xz]T表示***本体坐标系敏感到的角速度或加速度,对于陀螺仪而言X表示角速度矢量,而对于加速度计而言X表示加速度矢量,xx xy xz分别表示X沿着***本体坐标系的分量;
B=[b1 b2 … bn]T表示n个传感器的零偏矢量;
H'=[h1',h2',…,hi',…hn']T表示***实际安装矩阵,其中,hi'描述第i个陀螺仪或加速度计相对于***本体坐标系的实际安装方向矢量,H'=H+δα·P+δβ·Q;
此时K、P、Q、δα、δβ、H、H'和B均为常值;
步骤二:确定斜置RSINS标定方案,包括确定三轴转台位置,加速度计四位置标定方法,确定陀螺仪标定方法,采用陀螺仪四位置标定方法或陀螺仪三位置转动标定方法;
假设只考虑其中某一个传感器的标定量测方程,如下所示:
mi=ki(hi+δαi·pi+δβi·qi)·x+bi (5)
其中:mi、bi、ki分别表示第i个陀螺仪或加速度计的输出原始脉冲、零偏误差以及标度因数;
式(5)写为如下形式:
其中:hi1、hi2、hi3分别表示矢量hi中的第一个、第二个、第三个元素,pi1、pi2、pi3分别表示矢量pi中的第一个、第二个、第三个元素,qi1、qi2、qi3分别表示矢量qi中的第一个、第二个、第三个元素;
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2,k=0,±1,±2…,则有:
将RSINS放置于l个不同位置,使得地球转速ωie/重力加速度g在***本体坐标系的投影向量x均不同,且传感器输出值不全为0,若***观测矩阵满足如下条件,则ki,δαi和δβi具有唯一解:
其中:xl是指l个不同位置下的x值;
(1)确定三轴转台位置
假设在初始状态三轴转台的外框轴沿东-西向,中框轴沿南-北向,内框轴沿天-地向,斜置RSINS***本体坐标系沿东-北-天方向;此时三轴位置/速率转台可到达的24个位置为:
当***本体坐标系的z轴朝天,当地重力加速度在z轴上分量为g,表示为z:g,三轴位置/速率转台可到达的位置为:东北天、北西天、西南天、南东天;
当***本体坐标系的z轴朝天,当地重力加速度在z轴上分量为-g,表示为z:-g,三轴位置/速率转台可到达的位置为:东南地、南西地、西北地、北东地;
当***本体坐标系的y轴朝天,当地重力加速度在y轴上分量为g,表示为y:g,三轴位置/速率转台可到达的位置为:东天南、北天东、西天北、南天西;
当***本体坐标系的y轴朝天,当地重力加速度在y轴上分量为-g,表示为y:-g,三轴位置/速率转台可到达的位置为:东地北、北地西、西地南、南地东;
当***本体坐标系的x轴朝天,当地重力加速度在x轴上分量为g,表示为x:g,三轴位置/速率转台可到达的位置为:天东北、天北西、天西南、天南东;
当***本体坐标系的x轴朝天,当地重力加速度在x轴上分量为-g,表示为x:-g,三轴位置/速率转台可到达的位置为:地东南、地北东、地西北、地南西;
(2)加速度计四位置标定方法
加速度计标定时观测量为当地重力加速度,其在垂直方向上分量为g或-g,在水平方向分量为0;将RSINS本体坐标系的三个轴分别朝天和地,转台可到达的24个位置可分为6组;加速度计可利用24位置中的至少4个位置进行标定;对于任意一个加速度计,挑选东北天、东南地、东天南、天西南四个位置,采集某段数据后求均值可得:
1、东北天:
mi1=ki(hi+δαi·pi+δβi·qi)·[0 0 g]T+bi
2、东南地:
mi2=ki(hi+δαi·pi+δβi·qi)·[0 0 -g]T+bi
3、东天南:
mi3=ki(hi+δαi·pi+δβi·qi)·[0 g 0]T+bi
4、天西南:
mi4=ki(hi+δαi·pi+δβi·qi)·[g 0 0]T+bi
其中:mi1至mi4分别表示四个位置的加速度计输出原始脉冲量,因此加速度计零偏可表示为:
bi=(mi1+mi2)/2 (9)
利用以上四个位置数据可构建如下方程:
式中:
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2,k=0,±1,±2…,则有:
rank(Λ)=3 (11)
因此加速度计的标度因数及安装失准角可通过方程(10)获得唯一解;
(3)确定陀螺仪标定方法,采用陀螺仪四位置标定方法或者陀螺仪三位置转动标定方法,若仅以地球转速ωie作为观测量,当陀螺仪精度较高时,采用陀螺仪四位置标定方法,其余,采用陀螺仪三位置转动标定方法,具体为:
1)陀螺仪四位置标定方法
地球转速ωie在当地地理坐标系中的投影矢量为ωie=[0 ωn ωu]T,其中:ωn=ωie·cos(L)、ωu=ωie·sin(L),L为当地地理纬度;取与上述步骤(2)中加速度计标定时相同的四个位置,采集任意一个陀螺仪的某段数据后求均值可得:
1、东北天:
mi1=ki(hi+δαi·pi+δβi·qi)·[0 ωn ωu]T+bi
2、东南地:
mi2=ki(hi+δαi·pi+δβi·qi)·[0 -ωn -ωu]T+bi
3、东天南:
mi3=ki(hi+δαi·pi+δβi·qi)·[0 ωu -ωn]T+bi
4、天西南:
mi4=ki(hi+δαi·pi+δβi·qi)·[ωu 0 -ωn]T+bi
因此陀螺仪零偏可表示为:
bi=(mi1+mi2)/2 (12)
利用以上四个位置数据可构建如下方程:
式中:
其中,L表示当地地理纬度;
斜置冗余捷联惯导***满足αi≠k·π/2且βi≠k·π/2,k=0,±1,±2…,则有:
rank(Γ)=3 (14)
通过方程(13)即可得到陀螺仪标度因数及安装失准角;
2)陀螺仪三位置转动标定方法
将***本体的Xb轴朝东以ω的转速正向转动,在t1时刻Yb轴与北向夹角为θ,假设经过时间t***旋转n周,(n=1,2,3,…),即转过角度为2π·n(n=1,2,3,…);将时间t内Yb与Zb轴敏感的所有角速度分别积分可得:
其中,ωn=ωie·cos(L)、ωu=ωie·sin(L),L为当地地理纬度;另外两轴朝东转动时可得到同样的结论,因此陀螺仪可用三位置转动标定方法进行标定,步骤如下:
1、首先将***置于东北天和东南地并采集数据求取陀螺零偏并补偿;
2、将***本体坐标轴Xb、Yb和Zb分别朝东,且以角速度ω匀速转动整数周l,累加补偿零偏后的所有陀螺输出值,可得到下式:
如式(7)所示,矩阵Λ为满秩矩阵,因此解方程(16)即可得到陀螺仪的标度因数及安装失准角参数;
最终得到加速度计的零偏值、标度因数及安装失准角参数,陀螺仪的零偏值、标度因数及安装失准角参数,通过上述参数,得到实际使用量,用于斜置冗余捷联惯性导航***。
2.根据权利要求1所述的一种斜置冗余捷联惯性导航***的快速标定方法,其特征在于,所述的实际使用量为:
实际使用量=安装失准角矩阵*{(原始脉冲量-零偏值)/器件标度因数}
加速度计、陀螺仪的安装失准角、零偏值、标度因数分别代入上式,得到加速度计的实际使用量、陀螺仪的实际使用量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210404851.3A CN102927994B (zh) | 2012-10-23 | 2012-10-23 | 一种斜置冗余捷联惯性导航***的快速标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210404851.3A CN102927994B (zh) | 2012-10-23 | 2012-10-23 | 一种斜置冗余捷联惯性导航***的快速标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102927994A CN102927994A (zh) | 2013-02-13 |
CN102927994B true CN102927994B (zh) | 2015-08-05 |
Family
ID=47642852
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210404851.3A Active CN102927994B (zh) | 2012-10-23 | 2012-10-23 | 一种斜置冗余捷联惯性导航***的快速标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102927994B (zh) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103411623B (zh) * | 2013-07-10 | 2015-12-23 | 西北工业大学 | 速率陀螺校准方法 |
CN103389088B (zh) * | 2013-07-24 | 2015-11-25 | 北京航空航天大学 | 一种四冗余rfins最优配置方案的确定方法 |
CN103389089B (zh) * | 2013-07-25 | 2016-03-16 | 北京航空航天大学 | 一种六冗余型光纤捷联惯性导航*** |
CN103453904B (zh) * | 2013-09-26 | 2015-12-02 | 哈尔滨工程大学 | 一种惯性测量单元的冗余配置结构 |
CN103697918B (zh) * | 2013-12-26 | 2016-07-27 | 北京航天时代光电科技有限公司 | 一种三轴正交一轴斜置构型光纤陀螺惯测装置的标定方法 |
CN104344836B (zh) * | 2014-10-30 | 2017-04-19 | 北京航空航天大学 | 一种基于姿态观测的冗余惯导***光纤陀螺***级标定方法 |
CN104344837B (zh) * | 2014-10-30 | 2017-04-19 | 北京航空航天大学 | 一种基于速度观测的冗余惯导***加速度计***级标定方法 |
CN104567936A (zh) * | 2015-01-27 | 2015-04-29 | 北京航天时代光电科技有限公司 | 一种三轴斜置构型惯性测量装置参数标定方法 |
CN105352530B (zh) * | 2015-12-07 | 2018-03-02 | 深圳飞马机器人科技有限公司 | 一种惯性器件的精度测量标定方法 |
FR3046839B1 (fr) * | 2016-01-14 | 2018-01-19 | Safran Electronics & Defense | Dispositif et procede d'entretien d'attitude utilisant des gyrometres |
CN105424040B (zh) * | 2016-01-15 | 2019-09-13 | 极翼机器人(上海)有限公司 | 一种新型mems惯性传感器阵列余度配置方法 |
CN105588565B (zh) * | 2016-03-08 | 2018-10-26 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导***双轴旋转调制方法 |
CN106767917B (zh) * | 2016-12-08 | 2019-09-27 | 中国人民解放军国防科学技术大学 | 一种斜置冗余惯导***标定误差模型建模方法 |
CN106767925B (zh) * | 2016-12-29 | 2020-06-23 | 西安航天精密机电研究所 | 带双轴转位机构的惯导***三位置参数辨识对准方法 |
CN106840201B (zh) * | 2017-01-09 | 2020-02-21 | 西北工业大学 | 一种带双轴转位机构捷联惯导的三位置自对准方法 |
CN107478246B (zh) * | 2017-08-09 | 2020-11-13 | 南京理工大学 | 一种尺寸效应参数标定方法 |
CN109855653A (zh) * | 2019-03-08 | 2019-06-07 | 哈尔滨工程大学 | 一种冗余式mems-imu的降噪处理后的标定方法 |
CN110398245B (zh) * | 2019-07-09 | 2021-04-16 | 武汉大学 | 基于脚戴式惯性测量单元的室内行人导航姿态估计方法 |
CN110887505A (zh) * | 2019-09-29 | 2020-03-17 | 哈尔滨工程大学 | 一种冗余式惯性测量单元实验室标定方法 |
CN111486870B (zh) * | 2020-04-23 | 2021-01-05 | 中南大学 | 一种斜置捷联惯组***级标定方法 |
CN112325846B (zh) * | 2020-10-21 | 2021-07-02 | 北京航空航天大学 | 一种rtk倾斜测量精度提升方法 |
CN112710328B (zh) * | 2020-12-09 | 2024-04-16 | 中船航海科技有限责任公司 | 一种四轴冗余惯导***的误差标定方法 |
CN112698416B (zh) * | 2020-12-16 | 2022-05-03 | 湖南航天机电设备与特种材料研究所 | 一种适用于捷联惯导***的重力加速度测量方法及*** |
CN113776559B (zh) * | 2021-09-14 | 2023-07-14 | 北京控制工程研究所 | 一种基于误差对消的安装矩阵快速标定方法 |
CN113984088B (zh) * | 2021-10-11 | 2024-01-26 | 北京信息科技大学 | Mems惯性传感器多位置自动标定方法、装置及*** |
CN114061620B (zh) * | 2021-11-09 | 2024-05-10 | 武汉华中天易星惯科技有限公司 | 一种四冗余度惯导分立式标定方法及标定*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2256881C2 (ru) * | 2003-03-21 | 2005-07-20 | Федеральное государственное унитарное предприятие "Научно-исследовательский институт ПРИКЛАДНОЙ МЕХАНИКИ имени академика В.И. Кузнецова" | Способ определения параметров ориентации и навигации и бесплатформенная инерциальная навигационная система для быстровращающихся объектов |
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导***机上安装偏角的自动标定及补偿方法 |
-
2012
- 2012-10-23 CN CN201210404851.3A patent/CN102927994B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2256881C2 (ru) * | 2003-03-21 | 2005-07-20 | Федеральное государственное унитарное предприятие "Научно-исследовательский институт ПРИКЛАДНОЙ МЕХАНИКИ имени академика В.И. Кузнецова" | Способ определения параметров ориентации и навигации и бесплатформенная инерциальная навигационная система для быстровращающихся объектов |
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导***机上安装偏角的自动标定及补偿方法 |
Non-Patent Citations (5)
Title |
---|
Analysis and Compensation on Static Error of Accelerometer in GFSINS;Yanling Hao等;《2009 International Conference on Measuring Technology and Mechatronics Automation》;20091231;全文 * |
一种余度捷联惯导***标定结果的验证方法;卢佳振等;《***工程与电子技术》;20081130;第30卷(第11期);全文 * |
基于组合导航技术的光纤捷联***在线标定;张小跃等;《航空学报》;20081130;第29卷(第6期);全文 * |
捷联惯性传感器多余度配置的误差标定技术研究;华冰等;《传感器技术》;20051231;第24卷(第5期);全文 * |
斜置惯性测量单元的一体化标定技术;郭鹏飞等;《中国惯性技术学报》;20070630;第15卷(第3期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN102927994A (zh) | 2013-02-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102927994B (zh) | 一种斜置冗余捷联惯性导航***的快速标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN100585602C (zh) | 惯性测量***误差模型验证试验方法 | |
CN106525073B (zh) | 一种基于三轴转台的惯性空间陀螺标定试验方法 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导***加速度计***级标定方法 | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN104501835B (zh) | 一种面向空间应用异构imu初始对准的地面试验***及方法 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导***光纤陀螺***级标定方法 | |
CN101701825A (zh) | 高精度激光陀螺单轴旋转惯性导航*** | |
CN101319902A (zh) | 一种低成本组合式定位定向装置及组合定位方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN102508954A (zh) | Gps/sins组合导航全数字仿真方法及装置 | |
CN110160554A (zh) | 一种基于寻优法的单轴旋转捷联惯导***标定方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导***现场标定方法 | |
CN112595350B (zh) | 一种惯导***自动标定方法及终端 | |
CN103925930B (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN109752000A (zh) | 一种mems双轴旋转调制型捷联罗经初始对准方法 | |
CN102788598B (zh) | 基于三轴旋转的光纤捷联惯导***误差抑制方法 | |
CN107228665A (zh) | 一种混合式惯性平台*** | |
CN106940193A (zh) | 一种基于Kalman滤波的船舶自适应摇摆标定方法 | |
CN103743413A (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN103017765A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |