一种双轴旋转惯导IMU与转位机构安装误差的标定方法

一种双轴旋转惯导imu与转位机构安装误差的标定方法
技术领域
1.本发明涉及双轴旋转惯导误差标定技术领域，特别涉及一种双轴旋转惯导imu与转位机构安装误差的标定方法。


背景技术：

2.双轴旋转惯导由惯性测量单元(initial measurement unit，简称为imu)和转位机构组成，工作原理为：将imu安装在转位机构上，使imu在导航过程中可以相对固定的坐标系轴旋转，由于imu通过特定的旋转，将惯性器件的常值误差调制成为均值为零的周期变化量，可以在现有的惯性器件精度水平上，大大的提高双轴旋转惯导长航时的导航精度。因此，双轴旋转惯导被广泛地应用在需要高精度惯性导航系统的应用场合中，例如：舰艇、战车、飞机等运载体中。
3.在双轴旋转惯导的实际使用中，存在着imu与转位机构之间有安装误差将引起双轴旋转惯导输出姿态误差的问题，严重影响双轴旋转惯导输出姿态的精度。所以，若想将双轴旋转惯导应用于具有较高姿态精度需求的应用场合中，必须对imu与转位机构安装误差进行精确标定，并在标定后进行补偿以提高双轴旋转惯导的输出姿态精度。
4.授权发明专利cn104121926b提供了一种双轴旋转惯导系统转轴与敏感轴间安装误差角的标校方法，该方法把imu与转位机构安装误差角分为两组内环误差角并且分为两个步骤进行分别标校，在标校的两个步骤中均需要利用导航结果和转位机构的角度输出值，存在着误差角定义复杂化、标校过程复杂、标校精度依赖于导航结果和转位机构输出值的问题。已公开发明专利cn109211269a公开了一种双轴旋转惯导系统姿态角误差标定方法，该方法将imu与转位机构误差角分为旋转轴之间的非正交角和旋转轴的摆动角，然后利用标定试验标定所定义的误差角，存在着将imu与转位机构安装误差角定义复杂化、标定过程复杂的问题。授权发明专利cn110567452b提供了一种激光陀螺双轴旋转惯导系统姿态误差补偿方法，该方法获得了激光陀螺imu与转位机构间由于减振器变形带来的安装误差，但该方法无法标校imu与转位机构间由于机械安装造成的固定安装误差。
5.因此，基于上述技术问题，为了克服上述现有的双轴旋转惯导imu与转位机构安装误差的标定方法中存在着的误差角定义复杂化、标定过程复杂、标定精度不高的问题，需要提供一种简便、高精度的双轴旋转惯导imu与转位机构安装误差的标定方法。


技术实现要素：

6.本发明的目的是提供一种解决目前现有的双轴旋转惯导imu与转位机构安装误差的标定方法中存在着的误差角定义复杂化、标定过程复杂、标定精度不高的问题的双轴旋转惯导imu与转位机构安装误差的标定方法。
7.为此，本发明技术方案如下：
8.一种双轴旋转惯导imu与转位机构安装误差的标定方法，步骤如下：
9.s1、构建imu坐标系和旋转轴坐标系，并基于坐标系定义imu与转位机构的安装误
差角为imu坐标系相对旋转轴坐标系的三个欧拉角，包括θ
x
、θy和θz；进而，确定标定模型为：式中，为在imu坐标系中imu相对惯性空间的角速率，为在旋转轴坐标系中转位机构相对惯性空间的角速率；
10.s2、设计标定编排并进行标定试验，以获得标定数据；其中，
11.s201、标定编排设计为：1)基于初始位置：imu的xm轴朝东向，ym轴朝北向，zm轴朝天向，转位机构控制imu均速绕xm轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕xm轴反向旋转三周并保存陀螺输出2)基于初始位置：imu的xm轴朝西向，ym轴朝南向，zm轴朝天向，转位机构控制imu均速绕xm轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕xm轴反向旋转三周并保存陀螺输出3)基于初始位置：imu的xm轴朝东向，ym轴朝北向，zm轴朝天向，转位机构控制imu均速绕xm轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕xm轴反向旋转三周并保存陀螺输出4)基于初始位置：imu的xm轴朝东向，ym轴朝南向，zm轴朝地向，转位机构控制imu均速绕xm轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕xm轴反向旋转三周并保存陀螺输出
12.s202、基于和在y
t
轴的分量的平均值和在y
t
轴的分量的平均值和在z
t
轴的分量的平均值和在在z
t
轴的分量的平均值和在x
t
轴的分量的平均值和在x
t
轴的分量的平均值和在y
t
轴的分量的平均值和在y
t
轴的分量的平均值构建用于计算安装误差角的非线性方程组：
[0013][0014]
s203、标定试验：按照步骤s201设计的标定编排进行标定试验，试验过程中的陀螺输出数据，作为标定数据；
[0015]
s3、利用thin-shell算法处理标定数据获得安装误差角；
[0016]
s301、确定评价函数为：
[0017][0018]
s302、设定安装误差角θ
x
、θy和θz的取值范围为θ
xmin
～θ
xmax
、θ
ymin
～θ
ymax
和θ
zmin
～θ
zmax
；
[0019]
s303、获得安装误差角的中间值分别为：θ
xmean
＝(θ
xmin
+θ
xmax
)/2、θ
ymean
＝(θ
ymin
+θ
ymax
)/2和θ
zmean
(θ
zmin
+θ
zmax
)/2；
[0020]
s304、设定θy＝θ
ymean
、θz＝θ
zmean
，分别计算θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况
下对应的
[0021]
s305、分别计算θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况下对应的评价函数的数值：σ
max
、σ
mean
和σ
min
；
[0022]
s306、比较三个评价函数结果以确定下一次迭代的参数寻优范围：情况
①
：如果σ
min
＞σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝(θ
xmean
+θ
xmax
)/2且θ
xmin
＝(θ
xmean
+θ
xmin
)/2；情况
②
：如果σ
min
＜σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝θ
xmean
，θ
xmean
为θ
xmin
和新的θ
xmax
的中间值；情况
③
：如果σ
min
＞σ
mean
且σ
mean
＞σ
max
，则在下一次迭代中，取θ
xmin
＝θ
xmean
且θ
xmean
为θ
xmax
和新θ
xmin
的中间值；
[0023]
s307、重复步骤s303～步骤s306的单次迭代过程，直至迭代次数满足停止条件；最后一次迭代得到的θ
xmean
即为安装误差角θ
x
的最终标定结果δθ
x
；
[0024]
s308、参照步骤s303～步骤s307，设定θ
x
＝θ
xmean
、θz＝θ
zmean
，对θy进行寻优，并将最后一次迭代得到的θ
ymean
作为安装误差角θy的最终标定结果δθy；
[0025]
s309、参照步骤s303～步骤s307，设定θ
x
＝θ
xmean
、θy＝θ
ymean
，对θz进行寻优，并将最后一次迭代得到的θ
zmean
作为安装误差角θz的最终标定结果，并记为δθz；
[0026]
s4、利用由步骤s3得到标定的安装误差角δθ
x
、δθy和δθz，补偿双轴旋转惯导的输出姿态。
[0027]
进一步地，在步骤s1中，
[0028]
imu坐标系的原点为imu内的陀螺与加速度计的测量中心点，其xm轴与imu内的x向陀螺敏感轴方向一致，ym轴在imu内x向陀螺敏感轴和y向陀螺敏感轴构成的平面中且垂直于xm轴，zm轴垂直于xm轴与ym轴构成的平面；
[0029]
旋转轴坐标系的原点为imu坐标系的原点，其x
t
轴与外框架的旋转轴重合，z
t
轴与内框架的旋转轴重合，y
t
轴垂直于x
t
轴与z
t
轴构成的平面；
[0030]
进而，imu坐标系到旋转轴坐标系的转换矩阵为：
[0031][0032]
进一步地，在步骤s201中，转位机构的均速速率为10
°
/s。
[0033]
进一步地，在步骤s307中，迭代停止条件为迭代次数达到100次。
[0034]
进一步地，步骤s4的具体实施步骤为：
[0035]
s401、确定由于安装误差角造成的输出姿态误差转换矩阵：
[0036][0037]
式中，为由安装误差角造成的输出姿态误差转换矩阵；为转位机构在t时刻的姿态相对于在初始时刻t0的姿态的转换矩阵，由转位机构输出，为已知量；t
11
为第一行第一列的分量；t
12
为第一行第二列的分量；t
13
为第一行第三列的分量；t
21
为
第二行第一列的分量；t
22
为第二行第二列的分量；t
23
为第二行第三列的分量；t
31
为第三行第一列的分量；t
32
为第三行第二列的分量；t
33
为第三行第三列的分量；为补偿矩阵，由标定的安装误差角(δθ
x
、δθy和δθz)构成，其表达式为：
[0038][0039]
根据上面两式，即可获得输出姿态误差转换矩阵的分量；
[0040]
进而，根据输出姿态误差转换矩阵的分量，获得双轴旋转惯导的输出姿态补偿值，其表达式为：
[0041][0042]
式中，δα为双轴旋转惯导的输出姿态的横滚角补偿值；δβ为双轴旋转惯导的输出姿态的俯仰角补偿值；δγ为双轴旋转惯导的输出姿态的航向角补偿值；t
13
为输出姿态误差转换矩阵的第一行第三列分量；t
33
为输出姿态误差转换矩阵的第三行第三列分量；t
23
为输出姿态误差转换矩阵的第二行第三列分量；t
21
为输出姿态误差转换矩阵的第二行第一列分量；t
22
为输出姿态误差转换矩阵的第二行第二列分量；
[0043]
进而，补偿后的姿态角的计算公式为：
[0044][0045]
式中，横滚角α、俯仰角β和航向角γ均为未经标定补偿的双轴旋转惯导的输出姿态；经过标定补偿后的双轴旋转惯导的输出姿态为：补偿后的横滚角α
′
、补偿后的俯仰角β
′
和补偿后的航向角γ
′
。
[0046]
与现有技术相比，该双轴旋转惯导imu与转位机构安装误差的标定方法的有益效果在于：
[0047]
(1)本技术的标定方法将安装误差角定义为三个分量的误差角，并设计了四组八次标定编排进行标定试验，具有安装误差角定义简捷、试验简单的优点，且不依赖导航结果、不受转位机构输出姿态精度的限制，克服了现有方法中的安装误差角定义复杂化、标定试验复杂、受导航结果和转位机构输出姿态精度限制的问题，具有很好的实用价值；
[0048]
(2)在利用本技术方法进行标定和补偿前，双轴旋转惯导的姿态输出随着转位机构的转动具有较大的波动，最大姿态输出误差是安装误差角的二倍；而利用本技术提出的方法进行标定和补偿后，双轴旋转惯导的姿态输出精度得到明显改善，一小时内的姿态误差优于0.005
°
，实现提高双轴旋转惯导的姿态输出精度的效果，实用性佳。
附图说明
[0049]
图1为本发明的双轴旋转惯导imu与转位机构安装误差的标定方法的流程图；
[0050]
图2为本发明涉及的双轴旋转惯导的机械系统组成示意图；
[0051]
图3为本发明在步骤s101中构建的imu坐标系和旋转轴坐标系的示意图；
[0052]
图4为本发明在步骤s201中设计的标定试验编排的示意图；
[0053]
图5为本发明实施例中双轴旋转惯导在安装误差标定及补偿前的姿态输出示意图；
[0054]
图6为本发明实施例中双轴旋转惯导在安装误差标定及补偿后的姿态输出示意图。
具体实施方式
[0055]
下面结合附图及具体实施例对本发明做进一步的说明，但下述实施例绝非对本发明有任何限制。
[0056]
如图1所示，该双轴旋转惯导imu与转位机构安装误差的标定方法的具体实施步骤如下：
[0057]
s1、构建坐标系、定义安装误差角、确定标定模型；
[0058]
具体地，该步骤s1的具体实施方式如下：
[0059]
s101、构建imu坐标系和旋转轴坐标系；
[0060]
如图2所示，双轴旋转惯导由机箱1、转位机构2和惯性测量单元(简称为imu)3组成；其中，转位机构2由外框架201和内框架202组成，外框架201的旋转轴在水平方向上，内框架202的旋转轴指天，imu3固定安装在内框架202内；基于此，如图3所示，
[0061]
(1)构建imu坐标系，即m系，其表示为o-xmymzm；该坐标系为正交坐标系，其原点o点为imu内的陀螺与加速度计的测量中心点，xm轴与imu内的x向陀螺敏感轴方向一致，ym轴在imu内x向陀螺敏感轴和y向陀螺敏感轴构成的平面中且垂直于xm轴，zm轴垂直于xm轴与ym轴构成的平面；
[0062]
(2)旋转轴坐标系，即t系，其表示为o-x
tytzt
；该坐标系为正交坐标系，其原点o点为m系的原点，x
t
轴与外框架201的旋转轴重合，z
t
轴与内框架202的旋转轴重合，y
t
轴垂直于x
t
轴与z
t
轴构成的平面；
[0063]
s102、定义安装误差角：
[0064]
根据步骤s101构建的坐标系，定义imu与转位机构的安装误差角为m系相对t系的三个欧拉角，即θ
x
、θy和θz；其中，θ
x
、θy和θz的具体物理含义为：m系绕xm轴、y
′m轴和z
″m轴旋转至t系的旋转θ
x
角度、θy角度和θz角度后变换为t系；y
′m轴为m系在第一次旋转后的ym轴，z
″m轴为m系在第二次旋转后的zm轴；
[0065]
s103、确定标定模型：
[0066]
根据步骤s102定义的双轴旋转惯导imu与转位机构安装误差角(θ
x
、θy和θz)，则m系到t系的转换矩阵可以写为：
[0067][0068]
进而，构建标定模型，其表达式为：
[0069][0070]
式中，为在imu坐标系中imu相对惯性空间的角速率，由imu中的陀螺测量得到，其表达式为：
[0071][0072]
其中，为在imu坐标系中imu相对惯性空间的角速率在xm轴的分量，为在imu坐标系中imu相对惯性空间的角速率在ym轴的分量，为在imu坐标系中imu相对惯性空间的角速率在zm轴的分量；
[0073]
为在旋转轴坐标系中转位机构相对惯性空间的角速率，其表达式为：
[0074][0075]
其中，为在旋转轴坐标系中转位机构相对惯性空间的角速率在x
t
轴的分量，为在旋转轴坐标系中转位机构相对惯性空间的角速率在y
t
轴的分量，为在旋转轴坐标系中转位机构相对惯性空间的角速率在z
t
轴的分量；
[0076]
s2、设计并进行标定试验，以获得标定数据；
[0077]
具体地，该步骤s2的具体实施步骤为：
[0078]
s201、设计标定试验中的标定编排：
[0079]
如图4所示，为了从标定模型得到安装误差角，首先需要设计标定编排为：四组位置的八次速率试验；具体试验过程如下：
[0080]
记八次速率试验的编号依次为no.1～no.8，第一组位置对应的试验编号为no.1和no.2，第二组位置对应的试验编号为no.3和no.4，第三组位置对应的试验编号为no.5和no.6，第四组位置对应的试验编号为no.7和no.8；相应地，每组位置的具体编排为：
[0081]
1)第一组位置设计为“东-北-天”位置，其对应包括有试验no.1和试验no.2：
[0082]
基于初始位置为：imu的xm轴朝东向，ym轴朝北向，zm轴朝天向；
[0083]
试验no.1为：转位机构以10
°
/s的均速速率，控制imu绕xm轴正向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0084]
试验no.2为：转位机构以10
°
/s的均速速率，控制imu绕xm轴反向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0085]
2)第二组位置设计为“西-南-天”位置，其对应包括有试验no.3和试验no.4：
[0086]
基于初始位置为：imu的xm轴朝西向，ym轴朝南向，zm轴朝天向；
[0087]
试验no.3为：转位机构以10
°
/s的均速速率，控制imu绕xm轴正向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0088]
试验no.4为：转位机构以10
°
/s的均速速率，控制imu绕xm轴反向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0089]
3)第三组位置设计为“东-北-天”位置，其对应包括有试验no.5和试验no.6：
[0090]
基于初始位置为：imu的xm轴朝东向，ym轴朝北向，zm轴朝天向；
[0091]
试验no.5为：转位机构以10
°
/s的均速速率，控制imu绕zm轴正向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0092]
试验no.6为：转位机构以10
°
/s的均速速率，控制imu绕zm轴反向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0093]
4)第四组位置设计为“东-南-地”位置，其对应包括有试验no.7和试验no.8：
[0094]
基于初始位置为：imu的xm轴朝东向，ym轴朝南向，zm轴朝地向；
[0095]
试验no.7为：转位机构以10
°
/s的均速速率，控制imu绕zm轴正向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0096]
试验no.8为：转位机构以10
°
/s的均速速率，控制imu绕zm轴反向旋转三周，即旋转1080
°
，保存旋转期间imu中的陀螺输出，并记为
[0097]
s202、根据步骤s201的标定编排，获得计算安装误差角的非线性方程组；
[0098]
将试验no.1和试验no.3中保存的imu中的陀螺输出在y
t
轴的分量取平均值，并记为：将试验no.2和试验no.4中保存的imu中的陀螺输出在y
t
轴的分量取平均值，并记为：
[0099]
由于在imu绕某一轴旋转的条件下，陀螺敏感值在与其正交的两个轴上的投影为零，且通过控制imu旋转角度为360
°
的整数倍(本实施例中设定的imu旋转角度为360
°
的三倍)，因此，利用陀螺测量值取平均的方法，可以消除地球自转的影响，而通过将每组位置正反转条件下的陀螺测量值取差，则可以消除陀螺零偏误差的影响；进而得到：
[0100]
同理，将试验no.1和试验no.3中保存的imu中的陀螺输出在z
t
轴的分量取平均值，并记为：将试验no.2和试验no.4中保存的imu中的陀螺输出在z
t
轴的分量取平均值，并记为：进而得到：
[0101]
同理，将试验no.5和试验no.7中保存的imu中的陀螺输出在x
t
轴的分量取平均值，并记为：将试验no.6和试验no.8中保存的imu中的陀螺输出在x
t
轴的分量取平均值，并记为：进而得到：
[0102]
同理，将试验no.5和试验no.7中保存的imu中的陀螺输出在y
t
轴的分量取平均值，
并记为：将试验no.6和试验no.8中保存的imu中的陀螺输出在y
t
轴的分量取平均值，并记为：进而得到：
[0103]
即，获得如下的方程组：
[0104][0105]
在上式中，试验过程中imu中的陀螺输出在x
t
轴、y
t
轴和z
t
轴的分量可由步骤s1构建的标定模型：以及试验过程中的imu输出得到；
[0106]
因此，由步骤s201的标定编排获得的用于计算安装误差角的非线性方程组的表达式为：
[0107][0108]
s203、标定试验：在开机预热4小时，以减小温度对标定的影响的操作后，按照步骤s201设计的标定编排进行标定试验，该八次试验(试验no.1～试验no.8)对应所得的八组imu中的陀螺输出数据，作为标定数据；
[0109]
s3、利用thin-shell算法处理标定数据获得安装误差角；
[0110]
具体地，该步骤s3具体实施方式如下：
[0111]
s301、确定评价函数：
[0112]
根据步骤s202得到的安装误差角非线性方程组，确定评价函数为：
[0113][0114]
s302、设置安装误差角的取值范围：
[0115]
设置θ
x
的取值范围为θ
xmin
～θ
xmax
；在本实施例中，θ
xmin
为-5
°
，θ
xmax
为5
°
；
[0116]
设置θy的取值范围为θ
ymin
～θ
ymax
；在本实施例中，θ
ymin
为-5
°
，θ
ymax
为5
°
；
[0117]
设置θz的取值范围为θ
zmin
～θ
zmax
；在本实施例中，θ
zmin
为-5
°
，θ
zmax
为5
°
；
[0118]
s303、分别将θ
x
、θy和θz的最大值和最小值的平均值作为其中间值：
[0119]
即，θ
x
的中间值为θ
xmean
＝(θ
xmin
+θ
xmax
)/2；θy的中间值为θ
ymean
＝(θ
ymin
+θ
ymax
)/2；θz的中间值为θ
zmean
(θ
zmin
+θ
zmax
)/2；在本实施例中，第一次人为取值θ
x
、θy和θz的最小值均为-5
°
且最大值均为5
°
，使得θ
x
、θy和θz的中间值均为0
°
，在之后的迭代中，θ
x
、θy和θz的中间值随着迭代次数不断变化；
[0120]
s304、设定θy＝θ
ymean
、θz＝θ
zmean
，利用公式
以及步骤s2获得的标定数据进而，分别计算θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况下对应的
[0121]
s305、利用评价函数：
[0122][0123]
以及由步骤s304计算得到的三种情况下对应的分别获得θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况下对应的评价函数的数值，并分别记为：σ
max
、σ
mean
和σ
min
；
[0124]
s306、对由步骤s305得到的三个评价函数的数值进行比较，以确定下一次迭代的参数寻优范围：
[0125]
情况
①
：如果σ
min
＞σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝(θ
xmean
+θ
xmax
)/2且θ
xmin
＝(θ
xmean
+θ
xmin
)/2；
[0126]
情况
②
：如果σ
min
＜σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝θ
xmean
，θ
xmean
为θ
xmin
和新的θ
xmax
的中间值；
[0127]
情况
③
：如果σ
min
＞σ
mean
且σ
mean
＞σ
max
，则在下一次迭代中，取θ
xmin
＝θ
xmean
且θ
xmean
为θ
xmax
和新θ
xmin
的中间值；
[0128]
s307、重复步骤s303～步骤s306的单次迭代过程，直至迭代次数满足停止条件；最后一次迭代得到的θ
xmean
即为安装误差角θ
x
的最终标定结果，并记为δθ
x
；在本实施例中，停止条件设定为迭代次数达到100次；
[0129]
s308、同理，按照步骤s303～步骤s307的方法，通过设定θ
x
＝θ
xmean
、θz＝θ
zmean
对θy进行寻优，其在最后一次迭代得到的θ
ymean
即为安装误差角θy的最终标定结果，并记为δθy；
[0130]
s309、同理，按照步骤s303～步骤s307的方法，设定θ
x
＝θ
xmean
、θy＝θ
ymean
对θz进行寻优，其在最后一次迭代得到的θ
zmean
即为安装误差角θz的最终标定结果，并记为δθz；
[0131]
s4、利用由步骤s3得到标定的安装误差角δθ
x
、δθy和δθz，补偿双轴旋转惯导的输出姿态；
[0132]
具体地，该步骤s4的具体实施方式如下：
[0133]
s401、确定由于安装误差角造成的输出姿态误差转换矩阵，其表达式为：
[0134][0135]
式中，为由安装误差角造成的输出姿态误差转换矩阵；为转位机构在t时刻的姿态相对于在初始时刻t0的姿态的转换矩阵，由转位机构输出，为已知量；t
11
为第一
行第一列的分量；t
12
为第一行第二列的分量；t
13
为第一行第三列的分量；t
21
为第二行第一列的分量；t
22
为第二行第二列的分量；t
23
为第二行第三列的分量；t
31
为第三行第一列的分量；t
32
为第三行第二列的分量；t
33
为第三行第三列的分量；为补偿矩阵，由标定的安装误差角(δθ
x
、δθy和δθz)构成，其表达式为：
[0136][0137]
根据上面两式，即可获得输出姿态误差转换矩阵的分量；
[0138]
进而，根据输出姿态误差转换矩阵的分量获得双轴旋转惯导的输出姿态补偿值，其表达式为：
[0139][0140]
式中，δα为双轴旋转惯导的输出姿态的横滚角补偿值；δβ为双轴旋转惯导的输出姿态的俯仰角补偿值；δγ为双轴旋转惯导的输出姿态的航向角补偿值；t
13
为输出姿态误差转换矩阵的第一行第三列分量；t
33
为输出姿态误差转换矩阵的第三行第三列分量；t
23
为输出姿态误差转换矩阵的第二行第三列分量；t
21
为输出姿态误差转换矩阵的第二行第一列分量；t
22
为输出姿态误差转换矩阵的第二行第二列分量；
[0141]
进而，补偿后的姿态角的计算公式为：
[0142][0143]
式中，横滚角α、俯仰角β和航向角γ均为未经标定补偿的双轴旋转惯导的输出姿态；经过标定补偿后的双轴旋转惯导的输出姿态为：补偿后的横滚角α
′
、补偿后的俯仰角β
′
和补偿后的航向角γ
′
。
[0144]
为验证本发明提出的双轴旋转惯导imu与转位机构安装误差的标定方法的正确性和准确性，选用一套双轴旋转惯导进行了标定实验。
[0145]
标定实验中，双轴旋转惯导内的imu由三个零偏稳定性为0.01
°
/h的激光陀螺仪和三个零偏稳定性为10μg的加速度计组成；双轴旋转惯导的转位机构的姿态控制精度为5
″
(1σ)；
[0146]
采用本技术提供的方法进行imu与转位机构安装误差角的标定，获得的标定结果为：δθ
x
＝0.132
°
；δθy＝0.252
°
；δθz＝2.421
°
，并利用该标定结果补偿双轴旋转惯导的输出姿态。与此同时，作为对照，利用双轴旋转惯导进行输出姿态精度验证，姿态精度验证在双轴旋转惯导静止一小时的导航条件下进行。
[0147]
如图5所示为双轴旋转惯导在安装误差标定及补偿前的姿态输出示意图；从图中可以看出，在未补偿imu与转位机构安装误差的情况下，双轴旋转惯导的姿态输出随着转位
机构的转动具有较大的波动，最大航向输出误差接近5
°
，是标定的安装误差角δθz的二倍。
[0148]
如图6所示为双轴旋转惯导在安装误差标定及补偿后的姿态输出示意图；从图中可以看出，在补偿imu与转位机构安装误差后，双轴旋转惯导的姿态输出精度得到明显改善，一小时内的姿态误差优于0.005
°
。
[0149]
综上，通过上述对比实验，验证了本技术的双轴旋转惯导imu与转位机构安装误差的标定方法的正确性和准确性，该方法能很好地提高双轴旋转惯导的姿态输出精度，具有很好的实用性。
[0150]
本发明未详细公开的部分属于本领域的公知技术。尽管上面对本发明说明性的具体实施方式进行了描述，以便于本技术领域的技术人员理解本发明，但应该清楚，本发明不限于具体实施方式的范围，对本技术领域的普通技术人员来讲，只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内，这些变化时显而易见的，一切利用本发明构思的发明创造均为保护之列。

技术特征：
1.一种双轴旋转惯导imu与转位机构安装误差的标定方法，其特征在于，步骤如下：s1、构建imu坐标系和旋转轴坐标系，并基于坐标系定义imu与转位机构的安装误差角为imu坐标系相对旋转轴坐标系的三个欧拉角，包括θ
x
、θ
y
和θ
z
；进而，确定标定模型为：式中，为在imu坐标系中imu相对惯性空间的角速率，为在旋转轴坐标系中转位机构相对惯性空间的角速率；s2、设计标定编排并进行标定试验，以获得标定数据；其中，s201、标定编排设计为：1)基于初始位置：imu的x
m
轴朝东向，y
m
轴朝北向，z
m
轴朝天向，转位机构控制imu均速绕x
m
轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕x
m
轴反向旋转三周并保存陀螺输出2)基于初始位置：imu的x
m
轴朝西向，y
m
轴朝南向，z
m
轴朝天向，转位机构控制imu均速绕x
m
轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕x
m
轴反向旋转三周并保存陀螺输出3)基于初始位置：imu的x
m
轴朝东向，y
m
轴朝北向，z
m
轴朝天向，转位机构控制imu均速绕x
m
轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕x
m
轴反向旋转三周并保存陀螺输出4)基于初始位置：imu的x
m
轴朝东向，y
m
轴朝南向，z
m
轴朝地向，转位机构控制imu均速绕x
m
轴正向旋转三周并保存陀螺输出转位机构控制imu均速绕x
m
轴反向旋转三周并保存陀螺输出s202、基于和在y
t
轴的分量的平均值和在y
t
轴的分量的平均值和在z
t
轴的分量的平均值和在在z
t
轴的分量的平均值和在x
t
轴的分量的平均值和在x
t
轴的分量的平均值和在y
t
轴的分量的平均值和在y
t
轴的分量的平均值构建用于计算安装误差角的非线性方程组：s203、标定试验：按照步骤s201设计的标定编排进行标定试验，试验过程中的陀螺输出数据，作为标定数据；s3、利用thin-shell算法处理标定数据获得安装误差角；s301、确定评价函数为：s302、设定安装误差角θ
x
、θ
y
和θ
z
的取值范围为θ
xmin
～θ
xmax
、θ
ymin
～θ
ymax
和θ
zmin
～θ
zmax
；s303、获得安装误差角的中间值分别为：θ
xmean
＝(θ
xmin
+θ
xmax
)/2、θ
ymean
＝(θ
ymin
+θ
ymax
)/2
和θ
zmean
(θ
zmin
+θ
zmax
)/2；s304、设定θ
y
＝θ
ymean
、θ
z
＝θ
zmean
，分别计算θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况下对应的s305、分别计算θ
x
＝θ
xmax
、θ
x
＝θ
xmean
和θ
x
＝θ
xmin
三种情况下对应的评价函数的数值：σ
max
、σ
mean
和σ
min
；s306、比较三个评价函数结果以确定下一次迭代的参数寻优范围：情况
①
：如果σ
min
＞σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝(θ
xmean
+θ
xmax
)/2且θ
xmin
＝(θ
xmean
+θ
xmin
)/2；情况
②
：如果σ
min
＜σ
mean
且σ
mean
＜σ
max
，则在下一次迭代中，取θ
xmax
＝θ
xmean
，θ
xmean
为θ
xmin
和新的θ
xmax
的中间值；情况
③
：如果σ
min
＞σ
mean
且σ
mean
＞σ
max
，则在下一次迭代中，取θ
xmin
＝θ
xmean
且θ
xmean
为θ
xmax
和新θ
xmin
的中间值；s307、重复步骤s303～步骤s306的单次迭代过程，直至迭代次数满足停止条件；最后一次迭代得到的θ
xmean
即为安装误差角θ
x
的最终标定结果δθ
x
；s308、参照步骤s303～步骤s307，设定θ
x
＝θ
xmean
、θ
z
＝θ
zmean
，对θ
y
进行寻优，并将最后一次迭代得到的θ
ymean
作为安装误差角θ
y
的最终标定结果δθ
y
；s309、参照步骤s303～步骤s307，设定θ
x
＝θ
xmean
、θ
y
＝θ
ymean
，对θ
z
进行寻优，并将最后一次迭代得到的θ
zmean
作为安装误差角θ
z
的最终标定结果，并记为δθ
z
；s4、利用由步骤s3得到标定的安装误差角δθ
x
、δθ
y
和δθ
z
，补偿双轴旋转惯导的输出姿态。2.根据权利要求1所述的双轴旋转惯导imu与转位机构安装误差的标定方法，其特征在于，在步骤s1中，imu坐标系的原点为imu内的陀螺与加速度计的测量中心点，其x
m
轴与imu内的x向陀螺敏感轴方向一致，y
m
轴在imu内x向陀螺敏感轴和y向陀螺敏感轴构成的平面中且垂直于x
m
轴，z
m
轴垂直于x
m
轴与y
m
轴构成的平面；旋转轴坐标系的原点为imu坐标系的原点，其x
t
轴与外框架的旋转轴重合，z
t
轴与内框架的旋转轴重合，y
t
轴垂直于x
t
轴与z
t
轴构成的平面；进而，imu坐标系到旋转轴坐标系的转换矩阵为：3.根据权利要求1所述的双轴旋转惯导imu与转位机构安装误差的标定方法，其特征在于，在步骤s201中，转位机构的均速速率为10
°
/s。4.根据权利要求1所述的双轴旋转惯导imu与转位机构安装误差的标定方法，其特征在于，在步骤s307中，迭代停止条件为迭代次数达到100次。5.根据权利要求1所述的双轴旋转惯导imu与转位机构安装误差的标定方法，其特征在于，步骤s4的具体实施步骤为：s401、确定由于安装误差角造成的输出姿态误差转换矩阵：
式中，为由安装误差角造成的输出姿态误差转换矩阵；为转位机构在t时刻的姿态相对于在初始时刻t0的姿态的转换矩阵，由转位机构输出，为已知量；t
11
为第一行第一列的分量；t
12
为第一行第二列的分量；t
13
为第一行第三列的分量；t
21
为第二行第一列的分量；t
22
为第二行第二列的分量；t
23
为第二行第三列的分量；t
31
为第三行第一列的分量；t
32
为第三行第二列的分量；t
33
为第三行第三列的分量；为补偿矩阵，由标定的安装误差角(δθ
x
、δθ
y
和δθ
z
)构成，其表达式为：根据上面两式，即可获得输出姿态误差转换矩阵的分量；进而，根据输出姿态误差转换矩阵的分量，获得双轴旋转惯导的输出姿态补偿值，其表达式为：式中，δα为双轴旋转惯导的输出姿态的横滚角补偿值；δβ为双轴旋转惯导的输出姿态的俯仰角补偿值；δγ为双轴旋转惯导的输出姿态的航向角补偿值；t
13
为输出姿态误差转换矩阵的第一行第三列分量；t
33
为输出姿态误差转换矩阵的第三行第三列分量；t
23
为输出姿态误差转换矩阵的第二行第三列分量；t
21
为输出姿态误差转换矩阵的第二行第一列分量；t
22
为输出姿态误差转换矩阵的第二行第二列分量；进而，补偿后的姿态角的计算公式为：式中，横滚角α、俯仰角β和航向角γ均为未经标定补偿的双轴旋转惯导的输出姿态；经过标定补偿后的双轴旋转惯导的输出姿态为：补偿后的横滚角α
′
、补偿后的俯仰角β
′
和补偿后的航向角γ
′
。

技术总结
本发明公开了一种双轴旋转惯导IMU与转位机构安装误差的标定方法，步骤为：S1、构建IMU坐标系和旋转轴坐标系，以定义IMU与转位机构的安装误差角并确定标定模型；S2、设计标定编排并进行标定试验以获得标定数据；S3、利用Thin-shell算法处理标定数据获得安装误差角；S4、利用标定的安装误差角Δθ


技术研发人员：蔡庆中 涂勇强 杨功流 李晶 尹洪亮
受保护的技术使用者：北京航空航天大学
技术研发日：2022.07.15
技术公布日：2022/11/1