谭强俊,程永生,唐彬,刘显学,周浩,李寅鑫
(中国工程物理研究院 电子工程研究所,四川 绵阳 621000)
摘要:
振动环境下叠加在航姿参考系统(AHRS)加速度计敏感轴上的杆臂效应会对加速度计测姿精度造成极大的影响.本文对杆臂效应处理算法中的低通滤波法和力学补偿法进行分析.低通滤波法滤除杆臂效应会有整流误差残存.力学补偿法对杆臂效应中向心加速度项的补偿受限于陀螺测量精度,对杆臂效应中切向加速度项的补偿会因为直接对角速度微分求取角加速度造成误差激剧放大.针对低通滤波法与力学补偿法各自存在的不足,提出一种改进的杆臂效应补偿方法.对杆臂效应中的向心加速度项的补偿,设定角频率阈值作为判定值.在低于给定角频率阈值工况下采用低通滤波法,而在高于给定角频率阈值工况下采用力学补偿+低通滤波法.对杆臂效应中的切向加速度项的补偿,提出2种多加速度计构型,根据加速度计构型中各加速度计输出值,构造解析公式求解角加速度,避免直接微分法造成的误差放大.通过对改进补偿方法的理论推导、分析和仿真,并与低通滤波法和力学补偿法相对比,改进补偿方法显著地提高了杆臂效应误差补偿精度.
关键词: 杆臂效应补偿 多加速度计 低通滤波 力学补偿 向心加速度 切向加速度
DOI:10.11918/201906153
分类号:U666.1
文献标识码:A
基金项目:中国工程物理研究院超精密重点实验室基金(ZM18006)
Improved method of lever arm effect compensation for AHRS
TAN Qiangjun,CHENG Yongsheng,TANG Bin,LIU Xianxue,ZHOU Hao,LI Yinxin
(Institute of Electronic Engineering, China Academy of Engineering Physics, Mianyang 621000, Sichuan, China)
Abstract:
The lever arm effect superimposed on the accelerometer sensitive axis of the attitude and heading reference system (AHRS) under vibration environment will greatly affect the accuracy of the attitude measurement based on the accelerometer. This paper analyzes the low-pass filtering method and the mechanical compensation method in the lever arm effect processing algorithms. The low pass filtering method will have rectification error residual. The compensation of the centripetal acceleration term in the lever arm effect by the mechanical compensation method is limited by the gyro measurement accuracy. Meanwhile, the difference operation of angular velocity will greatly enlarge the compensation error of tangential acceleration term in lever arm effect. Aiming at the shortcomings of the low-pass filtering method and the mechanical compensation method, this paper proposes an improved compensation method of lever-arm effect. For the centripetal acceleration term, the angular frequency threshold is set as decision value. When the angular frequency is lower than the given angular frequency threshold, the low-pass filtering method is adopted; and when the angular frequency is higher than the given angular frequency threshold, the mechanical compensation+low-pass filtering method is adopted. For the tangential acceleration term, the angular acceleration can be solved analytically by multiple accelerometers, which can avoid the error amplification caused by differential operation. Through the theoretical derivation, analysis and simulation, the improved compensation method significantly improves the compensation precision of the lever arm effect, compared with the low-pass filtering method and the mechanical compensation method.
Key words: lever arm effect error compensation multiple accelerometers low-pass filtering mechanical compensation centripetal acceleration tangential acceleration
谭强俊, 程永生, 唐彬, 刘显学, 周浩, 李寅鑫. 航姿参考系统的改进杆臂效应补偿方法[J]. 哈尔滨工业大学学报, 2020, 52(5): 129-136. DOI: 10.11918/201906153.
TAN Qiangjun, CHENG Yongsheng, TANG Bin, LIU Xianxue, ZHOU Hao, LI Yinxin. Improved method of lever arm effect compensation for AHRS[J]. Journal of Harbin Institute of Technology, 2020, 52(5): 129-136. DOI: 10.11918/201906153.
基金项目 中国工程物理研究院超精密重点实验室基金(ZM18006) 作者简介 谭强俊(1978-), 男, 博士研究生;
程永生(1963-), 男, 研究员, 博士生导师 通信作者 周浩, zhh4513@163.com 文章历史 收稿日期: 2019-06-22
Abstract Full text Figures/Tables PDF
航姿参考系统的改进杆臂效应补偿方法
谭强俊, 程永生, 唐彬, 刘显学, 周浩, 李寅鑫
中国工程物理研究院 电子工程研究所, 四川 绵阳 621000
收稿日期: 2019-06-22
基金项目: 中国工程物理研究院超精密重点实验室基金(ZM18006)
作者简介: 谭强俊(1978-), 男, 博士研究生; 程永生(1963-), 男, 研究员, 博士生导师
通信作者: 周浩, zhh4513@163.com
摘要: 振动环境下叠加在航姿参考系统(AHRS)加速度计敏感轴上的杆臂效应会对加速度计测姿精度造成极大的影响.本文对杆臂效应处理算法中的低通滤波法和力学补偿法进行分析.低通滤波法滤除杆臂效应会有整流误差残存.力学补偿法对杆臂效应中向心加速度项的补偿受限于陀螺测量精度,对杆臂效应中切向加速度项的补偿会因为直接对角速度微分求取角加速度造成误差激剧放大.针对低通滤波法与力学补偿法各自存在的不足,提出一种改进的杆臂效应补偿方法.对杆臂效应中的向心加速度项的补偿,设定角频率阈值作为判定值.在低于给定角频率阈值工况下采用低通滤波法,而在高于给定角频率阈值工况下采用力学补偿+低通滤波法.对杆臂效应中的切向加速度项的补偿,提出2种多加速度计构型,根据加速度计构型中各加速度计输出值,构造解析公式求解角加速度,避免直接微分法造成的误差放大.通过对改进补偿方法的理论推导、分析和仿真,并与低通滤波法和力学补偿法相对比,改进补偿方法显著地提高了杆臂效应误差补偿精度.
关键词: 杆臂效应补偿 多加速度计 低通滤波 力学补偿 向心加速度 切向加速度
Improved method of lever arm effect compensation for AHRS
TAN Qiangjun, CHENG Yongsheng, TANG Bin, LIU Xianxue, ZHOU Hao, LI Yinxin
Institute of Electronic Engineering, China Academy of Engineering Physics, Mianyang 621000, Sichuan, China
Abstract: The lever arm effect superimposed on the accelerometer sensitive axis of the attitude and heading reference system (AHRS) under vibration environment will greatly affect the accuracy of the attitude measurement based on the accelerometer. This paper analyzes the low-pass filtering method and the mechanical compensation method in the lever arm effect processing algorithms. The low pass filtering method will have rectification error residual. The compensation of the centripetal acceleration term in the lever arm effect by the mechanical compensation method is limited by the gyro measurement accuracy. Meanwhile, the difference operation of angular velocity will greatly enlarge the compensation error of tangential acceleration term in lever arm effect. Aiming at the shortcomings of the low-pass filtering method and the mechanical compensation method, this paper proposes an improved compensation method of lever-arm effect. For the centripetal acceleration term, the angular frequency threshold is set as decision value. When the angular frequency is lower than the given angular frequency threshold, the low-pass filtering method is adopted; and when the angular frequency is higher than the given angular frequency threshold, the mechanical compensation+low-pass filtering method is adopted. For the tangential acceleration term, the angular acceleration can be solved analytically by multiple accelerometers, which can avoid the error amplification caused by differential operation. Through the theoretical derivation, analysis and simulation, the improved compensation method significantly improves the compensation precision of the lever arm effect, compared with the low-pass filtering method and the mechanical compensation method.
Keywords: lever arm effect error compensation multiple accelerometers low-pass filtering mechanical compensation centripetal acceleration tangential acceleration
由于加速度计的安装位置很难与载体摇摆参考点相重合,在角运动环境下加速度计输出会产生相对参考点的干扰加速度,即杆臂效应[1-2].航姿参考系统(Attitude and Heading Reference System,AHRS)中加速度计测量重力加速度在载体系各坐标轴上的投影分量从而获取水平姿态角,同时修正陀螺漂移[3-5].在静态条件下可获得较高的姿态测量精度.但在动态环境,叠加在加速度计敏感轴上的干扰加速度会对加速度计测姿精度造成极大影响.
根据现有文献,杆臂效应误差补偿研究可分为三类:1)低通滤波法,将杆臂效应视为高频干扰,通过低通滤波抑制杆臂效应误差.如文献[6]采用FIR和IIR低通滤波方法对加速度计杆臂效应在频域内进行滤除.但低通滤波法无法滤除振动产生的直流分量.2)力学补偿法,将陀螺仪测量的角速度,以及对角速度微分得到的角加速度代入杆臂效应公式,分别补偿杆臂效应中的向心加速度项和切向加速度项.文献[7-8]采用力学补偿法对弹载环境下的内外杆臂效应进行补偿.由于角加速度是通过对角速度测量值直接数值微分得到,微分运算会放大误差,进而引起切向加速度项误差放大.文献[9]根据
本文基于AHRS系统,通过对杆臂效应的误差机理以及现有滤波、补偿方法的不足进行分析,提出了一种改进的杆臂效应补偿方法,与现有方法相对比,显著提高了杆臂效应误差补偿精度.
1 杆臂效应的误差机理定义惯性坐标系(i系)为oixiyizi,载体坐标系(b系)为obxbybzb,加速度计安装在载体P处,ob点为载体的参考点,R为P点在惯性系中的位置矢量,R1为载体参考点ob在惯性系中的位置矢量,r为从载体参考点到P点的位置矢量,即为杆臂.位置示意图如图 1所示.
Fig. 1
图 1 坐标系间矢量关系 Fig. 1 Schematic diagram of frame of axes
在角运动环境下,由于载体参考点ob与加速度计安装点P不重合,在加速度计的输出中就含有相对参考点的杆臂效应误差,如式(1)所示
$\mathit{\boldsymbol{f}}_{{\rm{ip}}}^{\rm{b}} = \mathit{\boldsymbol{f}}_{{\rm{ib}}}^{\rm{b}} + \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{r}}^{\rm{b}}} + \mathit{\boldsymbol{\dot \omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{r}}^{\rm{b}}}.$ (1)
式中:fiPb为加速度计输出比力矢量在载体系b系下的投影,fibb为载体参考点ob的比力矢量在载体系b系下的投影,ωibb为载体相对惯性坐标系的角速度在载体系b系下的投影.
杆臂效应引起的干扰加速度表示为
${\rm{ \mathsf{ δ} }}{\mathit{\boldsymbol{f}}^{\rm{b}}} = \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times \left( {\mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{r}}^{\rm{b}}}} \right) + \mathit{\boldsymbol{\dot \omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{r}}^{\rm{b}}}.$ (2)
其中第1项定义为杆臂效应的向心加速度项,第2项定义为杆臂效应的切向加速度项.
杆臂效应对加速度计测姿的影响航姿参考系统中加速度计通过测量重力加速度在载体系各坐标轴上的投影分量来获取水平姿态角,以y轴为例
$\gamma = \arcsin \left( {\frac{{f_y^{\rm{b}}}}{g}} \right).$ (3)
式中:fyb为y轴加速度计输出比力,γ为横滚角,g为重力加速度,g=9.8 m/s2.
动态环境下杆臂效应会对加速度计测姿造成极大的影响.记叠加在y轴上的杆臂效应向心加速度项与切向加速度项分别为Δf1, Δf2.为简化分析,只考虑z轴上有角速度ωibzb与角加速度
$\left\{ {\begin{array}{*{20}{l}}{\omega _{{\rm{ib}}z}^{\rm{b}} = \omega ;}\\{\dot \omega _{{\rm{ib}}z}^{\rm{b}} = \dot \omega ;}\\{\omega _{{\rm{ib}}y}^{\rm{b}} = \omega _{{\rm{ib}}x}^{\rm{b}} = \dot \omega _{{\rm{ib}}y}^{\rm{b}} = \dot \omega _{{\rm{ib}}x}^{\rm{b}} = 0;}\\{{r_x} = r,{r_y} = {r_z} = 0.}\end{array}} \right.$
式中:ωibxb, ωibyb为载体绕x, y轴转动的角速度,单位(°/s),
由式(2)、(3)可以得到,杆臂效应造成的横滚角误差Δγ为
$\Delta \gamma = \frac{{\Delta f}}{{g\cos \gamma }} = \frac{{\Delta {f_1}}}{{g\cos \gamma }} + \frac{{\Delta {f_2}}}{{g\cos \gamma }}.$ (4)
在横滚角γ=0°时,由Δf1, Δf2分别造成的横滚角误差Δγ1, Δγ2如图 2所示.
Fig. 2
图 2 杆臂效应造成的测姿误差 Fig. 2 Attitude measurement errors caused by lever arm effect
图 2中,Δγ1为向心加速度造成的姿态误差;Δγ2为切向加速度造成的姿态误差.由图 2可见随着角速度、角加速度以及杆臂长度的增加,杆臂效应相应增大,加速度计测姿误差也越大,只有通过对加速度计杆臂效应进行有效的补偿,才能保证AHRS系统测姿精度.
2 现有杆臂效应补偿方法的不足目前处理杆臂效应的解析方法主要为低通滤波法和力学补偿法.在实际工程中二者应用广泛,但也存在其自身的不足.
2.1 低通滤波法的不足从现有文献看,采用低通滤波法主要应用在初始对准场景中.此时载体一般没有大的角机动,只有微幅晃动(振动).该环境下的干扰频率远高于舒拉频率以及地球自转频率,可视为高频干扰[6].但是低通滤波无法滤除振动产生的直流分量.
设在振动环境下,载体沿俯仰轴、横滚轴有频率相同,相位差为90°的角振动,即
$\left\{ {\begin{array}{*{20}{l}}{\theta \left( t \right) = {\theta _{\rm{m}}}\sin \mathit{\Omega }t,}\\{\gamma \left( t \right) = {\gamma _{\rm{m}}}\cos \mathit{\Omega }t,}\\{\psi \left( t \right) = 0.}\end{array}} \right.$ (5)
式中:Ω为振动的角频率,θ为俯仰角,θm为俯仰角的振动幅值,γ为横滚角,γm为横滚角的振动幅值,ψ为方位角.
由欧拉角微分方程,振动环境下的角速度为
$\begin{array}{*{20}{c}}{\mathit{\boldsymbol{\omega }}_{{\rm{nb}}}^{\rm{b}} = \left[ {\begin{array}{*{20}{c}}{\omega _{{\rm{nb}}x}^{\rm{b}}}\\{\omega _{{\rm{nb}}y}^{\rm{b}}}\\{\omega _{{\rm{nb}}z}^{\rm{b}}}\end{array}} \right] = \left[ {\begin{array}{*{20}{c}}0\\{\dot \gamma }\\0\end{array}} \right] + {\mathit{\boldsymbol{C}}_\gamma }\left[ {\begin{array}{*{20}{c}}{\dot \theta }\\0\\0\end{array}} \right] + {\mathit{\boldsymbol{C}}_\gamma }{\mathit{\boldsymbol{C}}_\theta }\left[ {\begin{array}{*{20}{c}}0\\0\\{ - \dot \psi }\end{array}} \right]}\\{ = \left[ \begin{array}{l}{\theta _{\rm{m}}}\mathit{\Omega }\cos \mathit{\Omega }t\cos \left( {{\gamma _{\rm{m}}}\cos \mathit{\Omega }t} \right)\\ - {\gamma _{\rm{m}}}\mathit{\Omega }\sin \mathit{\Omega }t\\{\theta _{\rm{m}}}\mathit{\Omega }\cos \mathit{\Omega }t\cos \left( {{\gamma _{\rm{m}}}\cos \mathit{\Omega }t} \right)\end{array} \right].}\end{array}$ (6)
在微幅振动环境下,可以把θ, γ当作小角度处理,即
$\mathit{\boldsymbol{\omega }}_{{\rm{nb}}}^{\rm{b}} = \left[ \begin{array}{l}{\theta _{\rm{m}}}\mathit{\Omega }\cos \mathit{\Omega }t\\ - {\gamma _{\rm{m}}}\mathit{\Omega }\sin \mathit{\Omega }t\\{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\mathit{\Omega }{\cos ^2}\mathit{\Omega }t\end{array} \right].$ (7)
由于地球自转相对动态环境下的角速度可以忽略,因此可认为ωibb≈ωnbb.将式(7)代入式(2)的向心加速度项中,可发现向心加速度项中存在直流分量:
$\left\{ {\begin{array}{*{20}{l}}{\left( {\omega _{{\rm{ib}}x}^{\rm{b}}} \right)_{{\rm{DC}}}^2 = \theta _{\rm{m}}^2{\mathit{\Omega }^2}/2,}\\{\left( {\omega _{{\rm{ib}}y}^{\rm{b}}} \right)_{{\rm{DC}}}^2 = \gamma _{\rm{m}}^2{\mathit{\Omega }^2}/2,}\\{\left( {\omega _{{\rm{ib}}z}^{\rm{b}}} \right)_{{\rm{DC}}}^2 = 3\gamma _{\rm{m}}^2\theta _{\rm{m}}^2{\mathit{\Omega }^2}/8.}\end{array}} \right.$ (8)
由式(8)可见,振动环境下向心加速度项存在直流分量,依靠低通滤波无法将直流分量滤除.
对式(6)求角加速度,可得
$\mathit{\boldsymbol{\dot \omega }}_{{\rm{nb}}}^{\rm{b}} = {\mathit{\Omega }^2}\left[ \begin{array}{l} - {\theta _{\rm{m}}}\sin \mathit{\Omega }t - \gamma _{\rm{m}}^2{\theta _{\rm{m}}}(\sin 3\mathit{\Omega }t + \sin \mathit{\Omega }t)/4\\ - {\gamma _{\rm{m}}}\cos \mathit{\Omega }t\\ - {\theta _{\rm{m}}}{\gamma _{\rm{m}}}\sin 2\mathit{\Omega t}\end{array} \right].$
在振动环境下角加速度仍为振荡形式,通过低通滤波可滤除切向加速度.但在机动环境下,若角加速度也包含有直流项时,低通滤波无法滤除角加速度直流项.
2.2 力学补偿法的不足力学补偿法通过陀螺仪输出获取角速度ωibb补偿向心加速度项,通过对角速度ωibb求微分获得角加速度
$\mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}}\left( {t + \Delta T} \right) - \mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}}\left( t \right) = \mathit{\boldsymbol{a}}\Delta T.$ (9)
式中:
$var\left( {\mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}}\left( {t + \Delta T} \right) - \mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}}\left( t \right)} \right) = var\left( {\mathit{\boldsymbol{a}}\Delta T} \right).$ (10)
令
$var\left( \mathit{\boldsymbol{a}} \right) = 2{\mathit{\boldsymbol{Q}}_{\rm{ \mathsf{ ω} }}}/\Delta {T^2}.$ (11)
由此可看出微分求角加速度
3 一种改进的杆臂效应补偿方法利用低通滤波法,杆臂效应中的向心加速度项会残存整流误差项;再者当角加速度也含有直流分量时,杆臂效应中的切向加速度项也会出现低通滤波无法滤除的整流误差.采用力学补偿法,向心加速度项的求解误差会受到陀螺测量误差的影响;而通过角速度微分获取角加速度,会引起切向加速度项误差激剧放大.考虑到多加速度计可以直接解析地求解角加速度[17-18],可避免角速度微分计算造成的误差放大.因此综合考虑低通滤波法、力学补偿法以及多加速度计解析求解法,提出一种改进的杆臂效应补偿方法见图 3.对于杆臂效应中的向心加速度,在低于给定角频率阈值工况下采用低通滤波法,在高于给定角频率阈值工况下采用力学补偿+低通滤波法.对杆臂效应中的切向加速度项,通过多加速度计解析求解角加速度.
Fig. 3
图 3 改进的杆臂效应补偿方法 Fig. 3 Improved compensation method for lever arm effect
3.1 基于角频率阈值判决的向心加速度项补偿由于式(8)在振动环境下(ωibxb)2, (ωibyb)2, (ωibzb)2项会产生低通滤波无法滤除的直流分量.力学补偿法对这几项可由陀螺仪直接测量获取,令Δωibxb=Δωibyb=Δωibzb为陀螺仪测量误差.根据陀螺随机误差模型
$\mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}} = \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} + \Delta \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} = \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} + \mathit{\boldsymbol{b}} + \mathit{\boldsymbol{n}}.$ (12)
式中:
$\left\{ \begin{array}{l}\mathit{\boldsymbol{\hat \omega }}_{{\rm{ib}}}^{\rm{b}} = {\left[ {\begin{array}{*{20}{c}}{\hat \omega _{{\rm{ib}}x}^{\rm{b}}}&{\hat \omega _{{\rm{ib}}y}^{\rm{b}}}&{\hat \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right]^{\rm{T}}},\\\mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} = {\left[ {\begin{array}{*{20}{c}}{\omega _{{\rm{ib}}x}^{\rm{b}}}&{\omega _{{\rm{ib}}y}^{\rm{b}}}&{\omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right]^{\rm{T}}},\\\Delta \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} = {\left[ {\begin{array}{*{20}{c}}{\Delta \omega _{{\rm{ib}}x}^{\rm{b}}}&{\Delta \omega _{{\rm{ib}}y}^{\rm{b}}}&{\Delta \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right]^{\rm{T}}},\\\mathit{\boldsymbol{b}} = {\left[ {\begin{array}{*{20}{c}}{{b_x}}&{{b_y}}&{{b_z}}\end{array}} \right]^{\rm{T}}},\\\mathit{\boldsymbol{n}} = {\left[ {\begin{array}{*{20}{l}}{{n_x}}&{{\mathit{n}_y}}&{{\mathit{n}_\mathit{z}}}\end{array}} \right]^{\rm{T}}}.\end{array} \right.$
则根据式(12),经过小波去噪后,可认为
$\Delta \omega _{{\rm{ib}}x}^{\rm{b}} = \Delta \omega _{{\rm{ib}}y}^{\rm{b}} = \Delta \omega _{{\rm{ib}}z}^{\rm{b}} = {b_x} = {b_y} = {b_z} = b.$ (13)
此时陀螺仪对(ωibxb)2项的测量误差绝对值为
$\left| {{{\left( {\hat \omega _{{\rm{ib}}x}^{\rm{b}}} \right)}^2} - {{\left( {\omega _{{\rm{ib}}x}^{\rm{b}}} \right)}^2}} \right| \approx \left| {2\Delta \omega _{{\rm{ib}}x}^{\rm{b}}\omega _{{\rm{ib}}x}^{\rm{b}}} \right| = \left| {2\omega _{{\rm{ib}}x}^{\rm{b}}b} \right|,$ (14)
将式(7)代入式(14),即
$\left| {2\omega _{{\rm{ib}}x}^{\rm{b}}b} \right| = \left| {2{\theta _{\rm{m}}}\Omega b\cos \Omega t} \right|,$ (15)
此时陀螺仪对(ωibyb)2项的测量误差绝对值为
$\left| {{{\left( {\hat \omega _{{\rm{ib}}y}^{\rm{b}}} \right)}^2} - {{\left( {\omega _{{\rm{ib}}y}^{\rm{b}}} \right)}^2}} \right| \approx \left| {2\Delta \omega _{{\rm{ib}}y}^{\rm{b}}\omega _{{\rm{ib}}y}^{\rm{b}}} \right| = \left| {2\omega _{{\rm{ib}}y}^{\rm{b}}b} \right|,$ (16)
将式(7)代入式(16),即
$\left| {2\omega _{{\rm{ib}}y}^{\rm{b}}b} \right| = \left| { - 2{\gamma _{\rm{m}}}\Omega b\sin \Omega t} \right|,$ (17)
此时陀螺仪对(ωibzb)2项的测量误差绝对值为
$\left| {{{\left( {\hat \omega _{{\rm{ib}}z}^{\rm{b}}} \right)}^2} - {{\left( {\omega _{{\rm{ib}}z}^{\rm{b}}} \right)}^2}} \right| \approx \left| {2\Delta \omega _{{\rm{ib}}z}^{\rm{b}}\omega _{{\rm{ib}}z}^{\rm{b}}} \right| = \left| {2\omega _{{\rm{ib}}z}^{\rm{b}}b} \right|,$ (18)
将式(7)代入式(18),即
$\left| {2\omega _{{\rm{ib}}z}^{\rm{b}}b} \right| = \left| {{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\Omega b\left( {1 + \cos 2\Omega t} \right)} \right|.$ (19)
由式(15)、式(17)可以看出采用力学补偿后(ωibxb)2, (ωibyb)2的计算误差仍为振荡形式,通过低通滤波没有整流误差.而由式(19)可以看出,力学补偿后(ωibzb)2再经过低通滤波仍有残存整流误差|γmθmΩb|.
将力学补偿后的整流误差|γmθmΩb|与对应的通过低通滤波后残存整流误差3γm2θm2Ω2/8比较.
设角频率阈值Ω0为
${\Omega _0} = 8\left| b \right|/\left( {3{\gamma _{\rm{m}}}{\theta _{\rm{m}}}} \right),$ (20)
当Ω≥Ω0时,有
$\left| {{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\Omega b} \right| \le 3\gamma _{\rm{m}}^2\theta _{\rm{m}}^2{\Omega ^2}/8,$ (21)
而在Ω < Ω0时,有
$\left| {{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\Omega b} \right| > 3\gamma _{\rm{m}}^2\theta _{\rm{m}}^2{\Omega ^2}/8.$ (22)
由式(21)、(22)可见,当角频率Ω大于角频率阈值Ω0时,采用力学补偿+低通滤波法造成的残存整流误差小于直接采用低通滤波造成的整流误差;而在角频率Ω小于角频率阈值Ω0时,直接采用低通滤波造成的整流误差小于采用力学补偿+低通滤波法造成的残存整流误差.
3.2 利用多加速度计补偿杆臂效应切向加速度项因微分法求解角加速度会放大误差,而低通滤波无法滤除直流分量,因此提出两种利用多加速度计解析求解角加速度的改进方法.
3.2.1 6加速度计构型1设置6加速度计构型,如图 4所示.6个加速度计安装在立方体6个面的中心,其敏感轴沿着每个面的对角线.令θb表示加速度计在载体系中敏感方向矢量,在6加速度计构型其中心位于P点,立方体的边长为2l时,由式(1)可得单个加速度计的输出表达式为
$A = {\left( {{\mathit{\boldsymbol{\theta }}^{\rm{b}}}} \right)^{\rm{T}}}\left( {\mathit{\boldsymbol{f}}_{{\rm{i}}P}^{\rm{b}} + \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times \mathit{\boldsymbol{\omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{l}}^{\rm{b}}} + \mathit{\boldsymbol{\dot \omega }}_{{\rm{ib}}}^{\rm{b}} \times {\mathit{\boldsymbol{l}}^{\rm{b}}}} \right),$ (23)
Fig. 4
图 4 六加速度计构型1 Fig. 4 Six accelerometer configuration 1
该构型方案的安装参数矩阵
$\left\{ \begin{array}{l}{\mathit{\boldsymbol{l}}^{\rm{b}}} = \left[ {\begin{array}{*{20}{c}}{\mathit{\boldsymbol{l}}_1^{\rm{b}}}& \cdots &{\mathit{\boldsymbol{l}}_6^{\rm{b}}}\end{array}} \right] = l\left[ {\begin{array}{*{20}{c}}0&0&{ - 1}&1&0&0\\0&{ - 1}&0&0&1&0\\{ - 1}&0&0&0&0&1\end{array}} \right],\\{\mathit{\boldsymbol{\theta }}^{\rm{b}}} = \left[ {\begin{array}{*{20}{c}}{\mathit{\boldsymbol{\theta }}_1^{\rm{b}}}& \cdots &{\mathit{\boldsymbol{\theta }}_6^{\rm{b}}}\end{array}} \right] = \frac{1}{{\sqrt 2 }}\left[ {\begin{array}{*{20}{c}}1&1&0&0&{ - 1}&{ - 1}\\1&0&1&{ - 1}&0&1\\0&1&1&1&1&0\end{array}} \right].\end{array} \right.$
将安装参数矩阵代入式(23),可得角加速度
$\left[ {\begin{array}{*{20}{c}}{\dot \omega _{{\rm{ib}}x}^{\rm{b}}}\\{\dot \omega _{{\rm{ib}}y}^{\rm{b}}}\\{\dot \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right] = \frac{{\sqrt 2 }}{{4l}}\left[ {\begin{array}{*{20}{c}}{{A_1} + {A_5} - {A_2} - {A_6}}\\{{A_3} - {A_1} - {A_4} - {A_6}}\\{{A_2} + {A_5} - {A_3} - {A_4}}\end{array}} \right].$ (24)
根据式(24),可由6个加速度计直接求解角加速度,避免了微分求解角加速度致使误差放大的问题.利用多加速度计求解角加速度
$\left[ {\begin{array}{*{20}{c}}{\Delta \dot \omega _{{\rm{ib}}x}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}y}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right] = \frac{{\sqrt 2 }}{{4l}}\left[ {\begin{array}{*{20}{c}}{\Delta {A_1} + \Delta {A_5} - \Delta {A_2} - \Delta {A_6}}\\{\Delta {A_3} - \Delta {A_1} - \Delta {A_4} - \Delta {A_6}}\\{\Delta {A_2} + \Delta {A_5} - \Delta {A_3} - \Delta {A_4}}\end{array}} \right].$ (25)
3.2.2 6加速度计构型2构型1中加速度计的布局相对6个基准面为倾斜安装.文献[20]指出斜置IMU,存在大安装误差角,安装误差角二次项的影响不能忽略.文献[21]指出斜装形式下的标定需要:1)设计倾斜的标定工装;2)设计专门的斜装标定算法.由此可见构型1中加速度计的布局对实际安装以及标定都带来一定的困难.文献[22]指出正交双加速度计可消除安装误差角影响.文献[23]中给出了一种便于安装的6加速度计构型,但该方案将多个加速度计安装在同一点,若采用体积较大的石英挠性加速度计,会产生较大的安装误差.为此设计了另一种构型:6加速度计构型2,如图 5所示.将各加速度计的安装位置移至各基准面的中心,避免了将多个加速度计安装在同一点造成的安装误差.各加速度计距离质心的距离均为l.同时构型2不存在大安装误差角问题.
Fig. 5
图 5 6加速度计构型2 Fig. 5 Six accelerometer configuration 2
该构型方案的安装参数矩阵
$\left\{ \begin{array}{l}{\mathit{\boldsymbol{l}}^{\rm{b}}} = \left[ {\begin{array}{*{20}{c}}{\mathit{\boldsymbol{l}}_1^{\rm{b}}}& \cdots &{\mathit{\boldsymbol{l}}_6^{\rm{b}}}\end{array}} \right] = l\left[ {\begin{array}{*{20}{c}}0&0&1&{ - 1}&0&0\\{ - 1}&1&0&0&0&0\\0&0&0&0&1&{ - 1}\end{array}} \right],\\{\mathit{\boldsymbol{\theta }}^{\rm{b}}} = \left[ {\begin{array}{*{20}{c}}{{\mathit{\boldsymbol{\theta }}_1}}& \cdots &{{\mathit{\boldsymbol{\theta }}_6}}\end{array}} \right] = \left[ {\begin{array}{*{20}{c}}0&0&0&0&1&1\\0&0&1&1&0&0\\1&1&0&0&0&0\end{array}} \right].\end{array} \right.$
代入式(23),可得角加速度为
$\left[ {\begin{array}{*{20}{c}}{\dot \omega _{{\rm{ib}}x}^{\rm{b}}}\\{\dot \omega _{{\rm{ib}}y}^{\rm{b}}}\\{\dot \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right] = \frac{1}{{2l}}\left[ {\begin{array}{*{20}{c}}{{A_1} - {A_2}}\\{{A_5} - {A_6}}\\{{A_3} - {A_4}}\end{array}} \right] - \left[ {\begin{array}{*{20}{c}}{\omega _{{\rm{ib}}y}^{\rm{b}}\omega _{{\rm{ib}}z}^{\rm{b}}}\\{\omega _{{\rm{ib}}z}^{\rm{b}}\omega _{{\rm{ib}}x}^{\rm{b}}}\\{\omega _{{\rm{ib}}x}^{\rm{b}}\omega _{{\rm{ib}}y}^{\rm{b}}}\end{array}} \right].$ (26)
对比式(24)及式(26)可见,构型1的角加速度的求解只需利用加速度计即可求解,而构型2的角加速度的求解,还须引入陀螺测量角速度信息才能完成角加速度的求解.该构型方案求解角加速度
$\left[ {\begin{array}{*{20}{c}}{\Delta \dot \omega _{{\rm{ib}}x}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}y}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right] = \frac{1}{{2l}}\left[ {\begin{array}{*{20}{c}}{\Delta {A_1} - \Delta {A_2}}\\{\Delta {A_5} - \Delta {A_6}}\\{\Delta {A_3} - \Delta {A_4}}\end{array}} \right] - \left[ \begin{array}{l}\omega _{{\rm{ib}}y}^{\rm{b}}\Delta \omega _{{\rm{ib}}z}^{\rm{b}} + \omega _{{\rm{ib}}z}^{\rm{b}}\Delta \omega _{{\rm{ib}}y}^{\rm{b}}\\\omega _{{\rm{ib}}z}^{\rm{b}}\Delta \omega _{{\rm{ib}}x}^{\rm{b}} + \omega _{{\rm{ib}}x}^{\rm{b}}\Delta \omega _{{\rm{ib}}z}^{\rm{b}}\\\omega _{{\rm{ib}}x}^{\rm{b}}\Delta \omega _{{\rm{ib}}y}^{\rm{b}} + \omega _{{\rm{ib}}y}^{\rm{b}}\Delta \omega _{{\rm{ib}}x}^{\rm{b}}\end{array} \right],$
将式(7)代入,可得振动环境下,经低通滤波后,角加速度误差
$\left[ {\begin{array}{*{20}{c}}{\Delta \dot \omega _{{\rm{ib}}x}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}y}^{\rm{b}}}\\{\Delta \dot \omega _{{\rm{ib}}z}^{\rm{b}}}\end{array}} \right] = \frac{1}{{2l}}\left[ {\begin{array}{*{20}{c}}{\Delta {A_1} - \Delta {A_2}}\\{\Delta {A_5} - \Delta {A_6}}\\{\Delta {A_3} - \Delta {A_4}}\end{array}} \right] - \frac{1}{{2l}}\left[ {\begin{array}{*{20}{c}}{{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\Omega \Delta \omega _{{\rm{ib}}y}^{\rm{b}}}\\{{\gamma _{\rm{m}}}{\theta _{\rm{m}}}\Omega \Delta \omega _{{\rm{ib}}x}^{\rm{b}}}\\0\end{array}} \right].$ (27)
相比构型1,构型2在振动环境下会有整流残差,且随着角频率、振幅的增加,其残留整流误差也随之增大.对比式(24)及式(26),在角加速度项含有直流分量的情况下,构型1能很好地补偿切向加速度,而构型2求解角加速度的误差项中含有角速度信息,也即是构型2求解角加速度的误差会随着角速度的增大而增大.
4 仿真验证 4.1 杆臂效应向心加速度项补偿设Δωibxb=Δωibyb=Δωibzb=0.2°/s为MEMS陀螺仪测量误差.俯仰角的振动幅值θm与横滚角的振动幅值γm范围为0°~10°,杆臂半径为r=1 m.分别采用低通滤波算法以及改进算法对杆臂效应向心加速度项进行仿真验算,如图 6所示.
Fig. 6
图 6 改进算法与低通滤波算法的比较 Fig. 6 Comparison between improved algorithm and low-pass filtering algorithm
由图 6可见,对于向心加速度的补偿,在角频率大于角频率阈值时,改进算法的残存整流误差小于低通滤波法残存整流误差.随着振幅增大,角频率阈值迅速减小,也即是在大振幅工况下,改进算法远胜于低通滤波法.
4.2 杆臂效应切向加速度项补偿在实际工程上应用的MEMS加速度计其精度已达到1×10-4 g[19].因此在仿真中设定加速度计常值漂移服从Gauss分布,均方差为10-4 g.
4.2.1 非振动低动态环境仿真时间设为650 s,载体的角加速度取为
Fig. 7
图 7 非振动环境下切向加速度误差对比 Fig. 7 Comparison of tangential acceleration errors in non-vibrating environment
4.2.2 非振动高动态环境角加速度为
Fig. 8
图 8 振动环境下切向加速度误差对比 Fig. 8 Comparison of tangential acceleration errors in vibrating environment
从图 7可见,构型1解析求解的切向加速度比直接微分法的精度提高了1个数量级.构型2的求解误差随着角速度的增大而增大,但在低动态环境下构型2的求解误差是可以接受的.在仿真650 s时,构型2的求解误差达到-0.042(m/s2),与直接微分法的求解误差相仿,而此时角速度达到325(°/s).也即是除了高动态环境下,一般的工程应用也可采用构型2.
4.2.3 振动环境设定振动频率范围为0~20 Hz,俯仰角的振幅θm与横滚角的振幅γm设为10°,仿真时间为40 s,两种加速度计构型在振动环境下的求解杆臂效应的切向加速度项误差如图 9所示(以x轴角加速度为例)
Fig. 9
图 9 内杆臂长度对加速度计测姿的影响 Fig. 9 Influence of inner lever arm on accelerometer attitude measurement
从图 9可看到,振动频率对构型1影响较小,而构型2的切向加速度误差随着振动频率增加而增大.结合图 7、图 8可看到,无论是振动环境或非振动环境,低动态或高动态,构型1的性能总是优于构型2.但是构型1的安装方式为斜置安装,需要设计专用的标定工装以及斜装标定算法,给工程实现带来一定的难度.构型2为正交安装,可以利用重力加速度的幅值平方g2作为参考基准,在标定过程中不受安装误差角的影响.同时无须设计专用标定工装,给工程实现带来一定便利.
实际工程中,惯性器件经过一定时间的使用其自身性能参数会随时间的推移与应用环境的变化而发生改变,同时在使用过程中由于摩擦、振动等因素的影响,惯性器件的安装位置、安装误差角也可能发生变化,需重新标定才能满足使用要求.因此对现场无精密标定设备、且工况为低振动、低动态环境,优先采用构型2.而高振动、高动态环境优先采用构型1.
4.2.4 内杆臂对多加速度计测姿的影响由式(24)、式(26)可看到,多加速度计的内杆臂长度越长,多加速度计测姿精度越高.以非振动低动态环境下测姿为例,内杆臂l长度范围为1 cm~4 cm,构型1和构型2的切向加速度误差如图 9所示.
从图 9可以看到构型1和构型2内杆臂l越大,求解的角加速度误差越小.但是在实际工程中,仪器安装的空间总是有限的,为提高求解精度在有限的安装空间里应尽可能增大内杆臂长度.
5 结论本文研究了杆臂效应误差对加速度计测姿精度的影响,针对低通滤波法与力学补偿法各自的不足,提出了一种改进的杆臂效应误差补偿方案.1)对向心加速度项,以振动角频率为判别标准,在低于给定角频率阈值时采用低通滤波法,在高于给定角频率阈值时采用力学补偿+低通滤波法.与传统的低通滤波法对比,改进算法显著提高了向心加速度项的补偿精度.2)对切向加速度项,设计了两种多加速度计构型方式,通过多加速度计解析求解角加速度,避免了角速度直接微分造成的误差放大.3)对加速度计构型1和构型2在三种工况环境下的求解精度进行了分析,同时根据构型1、构型2标定参数的难易,确定了构型1和构型2的适用范围.
参考文献
[1] 严恭敏, 严卫生, 徐德民. 捷联惯性测量组件中内杆臂效应分析与补偿[J]. 中国惯性技术学报, 2008, 16(2): 148.
YAN Gongmin, YAN Weisheng, XU Demin. Analysis and compensation on inner lever arm effect of strapdown inertial measurement unit[J]. Journal of Chinese Inertial Technology, 2008, 16(2): 148. DOI:10.13695/j.cnki.12-1222/o3.2008.02.020
[2] 崔鹏程, 邹志勤, 王翌, 等. 杆臂效应误差对晃动基座粗对准的影响[J]. 中国惯性技术学报, 2013, 21(4): 462.
CUI Pengcheng, ZOU Zhiqin, WANG Yi, et al. Influence of lever-arm effect error on coarse alignment on shaking base[J]. Journal of Chinese Inertial Technology, 2013, 21(4): 462. DOI:10.13695/j.cnki.12-1222/o3.2013.04.003
[3] LEE B, LEE Y J, SUNG S. Attitude determination algorithm based on relative quaternion geometry of velocity incremental vectors for cost efficient AHRS design[J]. International Journal of Aeronautical&Space Sciences, 2018(7): 1.
[4] ROH M S, KANG B S. Dynamic accuracy improvement of a MEMS AHRS for small UAVs[J]. International Journal of Precision Engineering and Manufacturing, 2018, 19(10): 1457. DOI:10.1007/s12541-018-0172-2
[5] NOURMOHAMMADI H, KEIGHOBADI J. Fuzzy adaptive integration scheme for low-cost SINS/GPS navigation system[J]. Mechanical Systems and Signal Processing, 2018, 99: 434. DOI:10.1016/j.ymssp.2017.06.030
[6] 程向红, 仲小丽, 冉昌艳, 等. 箭载SINS杆臂效应频域处理方法[J]. 中国惯性技术学报, 2013, 21(1): 61.
CHENG Xianghong, ZHONG Xiaoli, RAN Changyan, et al. Lever arm effect handling methods in frequency domain for launch vehicle SINS[J]. Journal of Chinese Inertial Technology, 2013, 21(1): 61. DOI:10.13695/j.cnki.12-1222/o3.2013.01.017
[7] 王海明, 李四海. 弹载惯组的杆臂效应补偿[J]. 中国惯性技术学报, 2013, 21(3): 332.
WANG Haiming, LI Sihai. Lever arm effect compensation for missile inertial measurement unit[J]. Journal of Chinese Inertial Technology, 2013, 21(3): 332. DOI:10.13695/j.cnki.12-1222/o3.2013.03.025
[8] 杨其, 刘新学, 孟少飞, 等. 舱内动环境对捷联惯导外杆臂误差补偿影响机理分析[J]. 系统工程与电子技术, 2018, 40(3): 630.
YANG Qi, LIU Xinxue, MENG Shaofei, et al. Mechanism analysis of dynamic environment in apparatus cabin for strapdown inertial navigation system external lever arm effect compensation[J]. Systems Engineering and Electronics, 2018, 40(3): 630. DOI:10.3969/j.issn.1001-506X.2018.03.22
[9] 俞文伯, 高国江, 房建成. 基座角振动对捷联惯导加速度测量所产生的影响及其误差补偿方法[J]. 中国惯性技术学报, 2002, 10(2): 18.
YU Wenbo, GAO Guojiang, FANG Jiancheng. Accelerations'measurement errors caused by base vibration and their eliminating approach[J]. Journal of Chinese Inertial Technology, 2002, 10(2): 18. DOI:10.13695/j.cnki.12-1222/o3.2002.02.004
[10] 李杨, 孙伟强, 王兴岭, 等. 空间不一致在动态对准中影响分析及补偿方法[J]. 中国惯性技术学报, 2018, 26(5): 13.
LI Yang, SUN Weiqiang, WANG Xingling, et al. Influence of space inconsistency on in-motion alignment and compensation method for large ship[J]. Journal of Chinese Inertial Technology, 2018, 26(5): 13. DOI:10.13695/j.cnki.12-1222/o3.2018.05.002
[11] 高亢, 任顺清, 陈希军, 等. 一种SINS/里程计行进间初始对准及杆臂补偿算法(英文)[J]. 中国惯性技术学报, 2018, 26(5): 81.
GAO Kang, REN Shunqing, CHEN Xijun, et al. Improved lever arm compensation algorithm for initial alignment of SINS/odometer[J]. Journal of Chinese Inertial Technology, 2018, 26(5): 81. DOI:10.13695/j.cnki.12-1222/o3.2018.05.013
[12] 姜述强, 刘繁明, 魏风梅, 等. 外杆臂效应对于船用捷联惯导罗经对准影响分析[J]. 哈尔滨工业大学学报, 2017, 49(9): 174.
JIANG Shuqiang, LIU Fanming, WEI Fengmei, et al. Influence of outside lever-arm effect on gyrocompass alignment for a marine strapdown inertial navigation system[J]. Journal of Harbin Institute of Technology, 2017, 49(9): 174. DOI:10.11918/j.issn.0367-6234.201609005
[13] GENG Chenghao, WU Falin, XU Shan, et al. Real-time estimation of dynamic lever arm effect of transfer alignment for wing's elastic deformation[C]//Proceedings of 2018 IEEE/ION Position, Location and Navigation Symposium (PLANS). Piscataway: IEEE, 2018
[14] 徐晓苏, 邹海军, 刘义亭, 等. 基于鲁棒滤波的挠曲变形和动态杆臂补偿算法[J]. 中国惯性技术学报, 2015, 23(1): 9.
XU Xiaosu, ZOU Haijun, LIU Yiting, et al. Compensation algorithm of flexural deformation and dynamic lever-arm based on robust filtering[J]. Journal of Chinese Inertial Technology, 2015, 23(1): 9. DOI:10.13695/j.cnki.12-1222/o3.2015.01.003
[15] BORKO A, KLEIN I, EVENTZUR G. GNSS/INS fusion with virtual lever-arm measurements[J]. Sensors, 2018, 18(7). DOI:10.3390/s18072228
[16] CHANG Guobin, LIU Ming. Hybrid Kalman and unscented Kalman filters for INS/GPS integrated system considering constant lever arm effect[J]. Journal of Central South University, 2015, 22(2): 575. DOI:10.1007/s11771-015-2558-y
[17] 杨杰.无陀螺捷联惯导系统加速度计构型研究与误差分析[D].哈尔滨: 哈尔滨工程大学, 2011
YANG Jie. Accelerometer configuration and error analysis for GFSINS[D]. Harbin: Harbin Engineering University, 2011
[18] 刘超军.无陀螺惯性测量单元关键技术的研究[D].华中科技大学, 2016
LIU Chaojun. Research on key techniques of gyro-free inertial measurement units[D]. Wuhan: Huazhong University of Science and Technology, 2016
[19] 岳鹏, 史震, 王剑, 等. 基于MEMS加速度计的无陀螺惯导系统[J]. 中国惯性技术学报, 2011, 19(2): 152.
YUE Peng, SHI Zhen, WANG Jian, et al. Gyro free inertial navigation system based on MEMS accelerometer[J]. Journal of Chinese Inertial Technology, 2011, 19(2): 152. DOI:10.13695/j.cnki.12-1222/o3.2011.02.004
[20] 郭鹏飞, 任章. 斜置惯性测量单元的一体化标定技术[J]. 中国惯性技术学报, 2007, 15(3): 377.
GUO Pengfei, REN Zhang. IMU integrated calibrating technique with skewed sensor axes[J]. Journal of Chinese Inertial Technology, 2007, 15(3): 377. DOI:10.13695/j.cnki.12-1222/o3.2007.03.028
[21] 程耀强, 徐德民, 万彦辉, 等. 斜装激光陀螺石英加速度计标定算法研究[J]. 压电与声光, 2013, 35(3): 362.
CHENG Yaoqiang, XU Demin, WAN Yanhui, et al. Study on calibration algorithm of skewed-installation laser gyros and quartz accelerometers[J]. Piezoelectrics&Acoustooptics, 2013, 35(3): 362. DOI:10.3969/j.issn.1004-2474.2013.03.016
[22] 蒋效雄, 刘雨, 苏宝库. 高精度加速度计重力场标定试验方法[J]. 吉林大学学报, 2010, 40(1): 287.
JIANG Xiaoxiong, LIU Yu, SU Baoku. Calibration test method of high-precision accelerometer in gravitational field[J]. Journal of Jilin University, 2010, 40(1): 287. DOI:10.13229/j.cnki.jdxbgxb2010.01.008
[23] 李绵伟. GF-SIMU中加速度计安装误差的标校方法研究[D].哈尔滨工程大学, 2008
LI Mianwei. The study on the calibration method of accelerometers installation errors in GF-SIMU[D]. Harbin: Harbin Engineering University, 2008