专利名称：一种捷联mems陀螺动态误差标定方法
技术领域：
本发明涉及一种捷联MEMS陀螺动态误差标定方法，利用三轴速率转台即可标定出捷联MEMS陀螺所有动态误差项系数。可应用于所有捷联MEMS陀螺误差标定，同时可为传统的机械式陀螺以及光纤陀螺动态误差标定提供参考。
背景技术：
陀螺是惯性导航系统的核心器件，决定了惯导系统的工作精度。随着硅MEMS技术的发展，低成本、小体积、低功耗的MEMS陀螺已广泛应用于微小型系统及战术武器的制导系统中，是未来最主要的中低精度角速度传感器。在捷联式惯性导航系统中，运载体的角运动形成的各种干扰力矩将引起陀螺漂移，造成角速度的测量误差，因此需要建立捷联MEMS陀螺动态误差辨识模型，设计准确的动态误差标定方法，通过误差补偿提高捷联MEMS陀螺实用精度。
现有的捷联MEMS陀螺的动态误差标定主要包括三位置动态标定以及“六位置正负转速”标定方法，这两种方法采用的动态误差模型中只考虑到了陀螺零偏、标度因数、安装误差系数等基本误差项，因此只能计算出陀螺零偏Df、标度因数Dz、安装误差系数Dx、Dy以及陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz，但无法标定出陀螺与角加速度有关项误差系数。现有的传统机械式陀螺误差标定采用恒速试验和角振动试验相结合的方法，其动态误差建模技术较成熟，建立了完备的动态误差辨识模型，采用速率试验标定出捷联陀螺误差系数Df、Dz、Dx、Dy、Dxx、Dyy、Dzz、Dxy、Dyx以及Dzx，而陀螺与角加速度有关的误差系数一般通过角振动试验标定，计算陀螺与角加速度有关误差系数Dx′、Dy′、Dz′。该方法需要三轴速率转台以及角振动台以及六面体过渡架等多种试验设备，限制了该方法的实际应用。为了克服恒速试验和角振动试验相结合的方法对标定试验设备要求的局限，充分利用三轴台的速率功能，研究人员提出了在三轴速率转台上实施的正交三轴速率试验，将三轴速率转台的内框、中框及外框输入合理的初始角，在三轴速率转台的正交三轴上同时施加独立的匀角速度输入时，经过坐标变换后，陀螺坐标系各轴敏感到的角速度分量为正余弦形式的交变角速度，从而能激发出包括角加速度误差在内的所有动态误差项，总动态误差包括1个常值分量和12个不同频率的分量，通过对输出数据进行谐波分析建立12个方程组，最后通过12个方程组解算各误差系数。该方法误差分离技术较难，标定解算工作量大，由于动态误差耦合以及陀螺零偏常值漂移导致标定的误差较大、精度较低。因为捷联MEMS陀螺零偏常值漂移较大，导致标定精度更低，因此该方法不适合于捷联MEMS陀螺的动态误差标定。
发明内容
本发明的技术解决问题是克服现有技术的不足，提供一种基于三轴速率转台的捷联MEMS陀螺动态误差标定方法，该方法可以精确地标定出捷联MEMS陀螺所有动态误差项系数，误差辨识精度高，且需要的试验设备少，简化了动态误差分离及辨识难度，减小了每一步标定的解算工作量。
本发明的技术解决方案为一种捷联MEMS陀螺动态误差标定方法的特点在于通过下列步骤实现(1)根据MEMS陀螺工作原理以及误差机理推导出的动态误差模型可表示为 Dyzωyωz+Dzxωzωx+Dxxωx2+Dyyωy2+Dzzωz2+ϵ]]>式中ω为陀螺输出，°/s； 分别为沿陀螺X轴、Y轴和Z轴的角加速度分量，rad/s2；ωx、ωy、ωz分别为沿陀螺X轴、Y轴和Z轴的角速度分量，rad/s；Df为陀螺零偏；Dx′、Dy′、Dz′分别为相应的与角加速度有关项误差系数，(°/s)/(rad/s2)；Dx、Dy分别为安装误差系数，(°/s)/(rad/s)；Dz为标度因数；Dxy、Dyz、Dzx为与角速度耦合二次有关项误差系数，(°/s)/(rad/s)2；Dxx、Dyy、Dzz分别为与角速度平方有关项误差系数，(°/s)/(rad/s)2；ε为陀螺随机误差，°/s；(2)利用三轴速率转台进行三轴速率试验，标定出捷联MEMS陀螺零偏Df、标度因数Dz、安装误差系数Dx、Dy以及陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz；(3)采用三耦合方位动态试验，设置陀螺坐标系OXYZ与三轴速率转台的台基坐标系OXTYTZT重合，设置转台内框XI轴初始角为45°，中框YM轴和外框ZO轴初始角均为0°，设置转台中框YM初始角为45°，内框XI轴和外框ZO轴初始角均为0°以及设置转台内框XI初始角为90°，中框YM轴初始角为45°和外框ZO轴初始角均为0°等三个方位。在每个方位转台外框ZO轴输入角速率按从小到大的顺序改变，分别给速率转台输入n°/10/s、-n°/10/s、2n°/10/s、-n°/10/s、3n°/10/s、-3n°/10/s、......、n°/s、-n°/s共20个角速率，n°/s表示陀螺测量范围的最大正转角速率，通过对试验数据的解算，标定出陀螺三个角速度耦合二次有关项误差系数Dxy、Dyz、Dzx；(4)利用三轴速率转台的速率功能，进行角加速度误差标定试验，设置转台内框XI初始角θx0＝0°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴转台中框YM轴以及外框ZO轴输入相同转速Ω；设置转台内框XI初始角θx0＝90°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴转台中框YM轴以及外框ZO轴输入相同转速Ω；通过对两组试验数据解算，标定陀螺三个与角加速度有关项误差系数Dx′、Dy′、Dz′。
本发明的原理是通过三轴速率试验，用最小二乘法计算陀螺中Z轴标度因数、两个安装误差系数分别为Dz=Σj=1nΩj·ω‾zzj-1nΣj=1nΩj·Σj=1nω‾zzjΣj=1nΩj2-1n(Σi=1nΩj)2]]>Dx=Σj=1nΩj·ω‾xzj-1nΣj=1nΩj·Σj=1nω‾xzjΣj=1nΩj2-1n(Σi=1nΩj)2]]>Dy=Σj=1nΩj·ω‾yzj-1nΣj=1nΩj·Σj=1nω‾yzjΣj=1nΩj2-1n(Σi=1nΩj)2]]>式中Ωj代表三轴速率转台ZT轴输入的角速度；ωzzj代表陀螺Z轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；ωxzj代表陀螺X轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；ωyzj代表陀螺Y轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；利用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz以及陀螺零偏DfNz＝polyfit(Ω(:)，ωzz(:)，2)；Dzz＝Nz(2)Nx＝polyfit(Ω(:)，ωxz(:)，2)；Dxx＝Nx(2)Ny＝polyfit(Ω(:)，ωyz(:)，2)；Dyy＝Ny(2)Df＝(Nz(0)+Nx(0)+Ny(0))/3式中，Nz，Nx，Ny代表拟和三维数组变量；Ω(:)代表转台输入转速数组变量；ωzz(:)代表陀螺Z轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量；ωxz(:)代表陀螺X轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量；ωyz(:)代表陀螺Y轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量。
利用三耦合方位动态试验，分别激励出陀螺耦合角速度二次项误差，利用三轴速率试验标定出的动态误差系数对各耦合方位每一速下陀螺输出进行补偿，计算出陀螺与角速度耦合二次有关项误差函数δωc＝Dxyωxωy+Dyzωyωz+Dzxωzωx利用第一耦合方位的动态试验数据，采用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度耦合二次有关项误差系数DyzNyz＝polyfit(Ω2(:)，2δωcyz(:)，1)；Dyz＝Nyz(1)式中，Nyz代表拟和二维数组变量；Ω2(:)代表转台输入转速平方项的数组变量；δωcyz(:)代表该方位下转台输入20个转速时陀螺的动态误差数组变量。同理计算陀螺与角速度耦合二次有关项误差系数Dxz和Dxy。
利用三轴速率转台的速率功能，设置两组试验，第一组试验设定三轴速率转台内框XI初始角θx0＝0，中框YM轴初始角θy0＝0和外框ZO轴初始角θz0＝0°，将三轴速率转台中框YM轴以及外框ZO轴输入相同转速Ω；第二组试验设定三轴速率转台内框XI初始角θx0＝90°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴速率转台中框YM轴以及外框ZO轴输入相同转速Ω。经过坐标变换后，陀螺坐标系各轴敏感到的角速度分量即为正余弦形式的交变角速度ωxωyωz=-Ωsin(Ωt+θy0)Ωsin(θx0)cos(θy0+Ωt)+Ωcos(θx0)Ωcos(θx0)cos(Ωt+θy0)-Ωsin(θx0)]]>从而能激发出包括角加速度误差在内的所有动态误差项，其中捷联陀螺三轴方向角加速度为 利用三轴速率试验以及和三耦合方位动态试验标定出的陀螺动态误差系数补偿陀螺输出，计算出陀螺与角加速度有关误差函数 将三轴角加速度代入陀螺与角加速度误差函数中可得 -Dx′Ω2cos(Ωt+θy0)-Dy′Ω2sin(θx0)sin(Ωt+θy0)-Dz′Ω2cos(θx0)sin(Ωt+θy0)=]]>-Dx′Ω2cos(Ωt+θy0)-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))sin(Ωt+θy0)=]]>Acos(Ωt+θy0)+Bsin(Ωt+θy0)]]>A＝-Dx′Ω2B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))对陀螺与角加速度误差数据进行谐波分析，可分离出信号的正弦分量和余弦分量，进而求得正弦分量的振幅A和余弦分量的振幅B。
第一组试验情况下，根据θx0＝90°，θy0＝0°和θz0＝0°，A＝-Dx′Ω2以及B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))可计算得Dx′＝-A1/Ω2Dz′＝-B1/Ω2第二组试验情况下，根据θx0＝0°，θy0＝0°和θz0＝0°，A＝-Dx′Ω2以及B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))可计算得Dy′＝-B2/Ω2本发明与现有技术相比的优点在于(1)需要的试验设备少，不需要具备角振动功能的专用试验设备，只需三轴速率转台，解决了需求多种试验设备的问题；(2)设计分步式标定试验，通过对局部动态误差的激励，简化了动态误差分离及辨识难度，减小了每一步标定的解算工作量；(3)通过三轴速率试验、三耦合方位动态试验以及角加速度误差标定试验，可精确标定出捷联MEMS陀螺所有动态误差项系数，误差辨识精度高。
图1为本发明的流程图；图2为本发明中三轴速率转台以及陀螺初始方位示意图；图3为本发明中三轴速率试验的三个位置示意图；图4为本发明中三耦合方位动态试验的三个方位示意图；图5为本发明中角加速度误差标定试验的两组实验方位示意图。
具体实施例方式
如图1所示，本发明的实施例采用的是一种双框架式硅MEMS陀螺，首先定义具体实施过程中利用到的各坐标系，如图2所示，三轴转台的台基坐标系为OXTYTZT，与地理坐标系OENU重合，外框坐标系为OXOYOZO，中框坐标系为OXMYMZM，内框坐标系为OXIYIZI，陀螺坐标系为OXYZ。MEMS陀螺捷联安装在内框上，即陀螺坐标系OXYZ始终与内框坐标系OXIYIZI重合。OXI指向内框架轴向，OYM指向中框架轴向，OZO指向外框架轴向，具体实施步骤如下(1)根据硅MEMS陀螺工作原理以及误差产生机理推导出MEMS陀螺完备动态误差模型 Dyzωyωz+Dzxωzωx+Dxxωx2+Dyyωy2+Dzzωz2+ϵ]]>式中ω为陀螺输出，°/s； 分别为沿陀螺X轴、Y轴和Z轴的角加速度分量，rad/s2；ωx、ωy、ωz分别为沿陀螺X轴、Y轴和Z轴的角速度分量，rad/s；Df为陀螺零偏；Dx′、Dy′、Dz′分别为相应的与角加速度有关项误差系数，(°/s)/(rad/s2)；Dx、Dy分别为安装误差系数，(°/s)/(rad/s)；Dz为标度因数；Dxy、Dyz、Dzx为与角速度耦合二次有关项误差系数，(°/s)/(rad/s)2；Dxx、Dyy、Dzz分别为与角速度平方有关项误差系数，(°/s)/(rad/s)2；ε为陀螺随机误差，°/s；(2)利用三轴速率转台设计三轴速率试验如图3所示，设置陀螺坐标系OXYZ与三轴速率转台的台基坐标系OXTYTZT重合，第一位置设置转台内框XI轴、中框YM轴和外框ZO轴的初始角均为0°，给陀螺供电预热20～30分钟后设定转台绕ZO轴正转，记录陀螺输出，停转；转台绕ZO轴反转，记录陀螺输出，停转。转台输入角速率按从小到大的顺序改变，分别给速率转台输入n°/10/s、-n°/10/s、2n°/10/s、-2n°/10/s、3n°/10/s、-3n°/10/s、......、n°/s、-n°/s共20个角速率，n°/s表示陀螺测量范围的最大正转角速率，对于本实施例采用的双框架式硅MEMS陀螺，其最大正转角速率为100°/s，在保证采集转动整周数据的前提下，对每一个角速率都记录1～5分钟左右的陀螺输出数据。
同理，第二位置设置转台中框YM初始角为90°，内框XI轴和外框ZO轴初始角均为0°以及第三位置设置转台内框XI初始角为90°，中框YM轴和外框ZO轴初始角均为0°等两方位，重复以上的工作，完成三方位正负速率试验。
用最小二乘法求陀螺中Z轴标度因数、两个安装误差系数分别为Dz=Σj=1nΩj·ω‾zzj-1nΣj=1nΩj·Σj=1nω‾zzjΣj=1nΩj2-1n(Σi=1nΩj)2---(2)]]>Dx=Σj=1nΩj·ω‾xzj-1nΣj=1nΩj·Σj=1nω‾xzjΣj=1nΩj2-1n(Σi=1nΩj)2---(3)]]>Dy=Σj=1nΩj·ω‾yzj-1nΣj=1nΩj·Σj=1nω‾yzjΣj=1nΩj2-1n(Σi=1nΩj)2---(4)]]>式中Ωj代表三轴速率转台ZT轴输入的角速度；ωzzj代表陀螺Z轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；ωxzj代表陀螺X轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；ωyzj代表陀螺Y轴与转台的台基坐标系中ZT轴重合时，转台输入第j个转速时陀螺的输出；利用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz以及陀螺零偏DfNz＝polyfit(Ω(:)，ωzz(:)，2)；Dzz＝Nz(2) (5)Nx＝polyfit(Ω(:)，ωxz(:)，2)；Dxx＝Nx(2) (6)Ny＝polyfit(Ω(:)，ωyz(:)，2)；Dyy＝Ny(2) (7)Df＝(Nz(0)+Nx(0)+Ny(0))/3 (8)式中，Nz，Nx，Ny代表拟和三维数组变量；Ω(:)代表转台输入转速数组变量；ωzz(:)代表陀螺Z轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量；ωxz(:)代表陀螺X轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量；ωyz(:)代表陀螺Y轴与转台的台基坐标系中ZT轴重合时，转台输入20个转速时陀螺的输出数组变量。
(3)三耦合方位动态试验如图4所示，首先设置坐标系OXYZ与三轴速率转台的台基坐标系OXTYTZT重合，第一耦合方位设置转台内框XI轴初始角为45°，中框YM轴和外框ZO轴的初始角均为0°，设定转台绕ZO轴正转，记录陀螺输出，停转；转台绕ZO轴反转，记录陀螺输出，停转。转台输入角速率按从小到大的顺序改变，分别给速率转台输入n°/10/s、-n°/10/s、2n °/10/s、-2n°/10/s、3n°/10/s、-3n°/10/s、......、n°/s、-n°/s共20个角速率，n°/s表示陀螺测量范围的最大正转角速率，对于本实施例采用的双框架式硅MEMS陀螺，其最大正转角速率为100°/s，在保证采集转动整周数据的前提下，对每一个角速率都记录1～5分钟左右的陀螺输出数据。
同理，第二耦合方位设置转台中框YM初始角为45°，内框XI轴和外框ZO轴初始角均为0°以及第三耦合方位设置转台内框XI初始角为90°，中框YM轴初始角为45°和外框ZO轴初始角均为0°等两方位，重复以上的工作，完成三耦合方位动态试验。
利用步骤2标定出的部分陀螺动态误差系数对各耦合方位每一转速下陀螺输出进行补偿计算出陀螺与角速度耦合二次有关项误差函数δωc＝Dxyωxωy+Dyzωyωz+Dzxωzωx(9)利用第一耦合方位的动态试验数据，采用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度耦合二次有关项误差系数DyzNyz＝polyfit(Ω2(:)，2δωcyz(:)，1)；Dyz＝Nyz(1) (10)式中，Nyz代表拟和二维数组变量；Ω2(:)代表转台输入转速平方项的数组变量；δωcyz(:)代表该方位下转台输入20个转速时陀螺的动态误差数组变量；同理，利用第二耦合方位的动态试验数据，采用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度耦合二次有关项误差系数DxzNxz＝polyfit(Ω2(:)，2δωcxz(:)，1)；Dxz＝Nxz(1) (11)式中，Nxz代表拟和二维数组变量；Ω2(:)代表转台输入转速平方项的数组变量；δωcxz(:)代表该方位下转台输入20个转速时陀螺的动态误差数组变量；同理，利用第三耦合方位的动态试验数据，采用MATLAB计算与仿真软件中的最小二乘拟和函数计算陀螺与角速度耦合二次有关项误差系数DxyNxy＝polyfit(Ω2(:)，2δωcxy(:)，1)；Dxy＝Nxy(1) (12)式中，Nxy代表拟和二维数组变量；Ω2(:)代表转台输入转速平方项的数组变量；δωcxy(:)代表该方位下转台输入20个转速时陀螺的动态误差数组变量；(4)利用三轴速率转台的速率功能，在三轴上同时输入独立匀角速度时，经过坐标变换后，陀螺坐标系各轴敏感到的角速度分量即为正余弦形式的交变角速度，从而能激发出包括角速度误差在内的所有动态误差项，通过对数据进行谐波分析处理就可分离出陀螺与角加速度误差系数。
设置两组试验，第一组试验设定三轴速率转台内框XI初始角θx0＝0，中框YM轴初始角θy0＝0和外框ZO轴初始角θz0＝0°，将三轴速率转台中框YM轴以及外框ZO轴输入相同转速Ω，采集3～5分钟陀螺输出数据。
第二组试验设定三轴速率转台内框XI初始角θx0＝90°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴速率转台中框YM轴以及外框ZO轴输入相同转速Ω，采集3～5分钟陀螺输出数据。
设三轴转台转动过程中各框绕相应轴分别转过θZ、θY、θX，此时从台基坐标系OXTYTZT到OXOYOZO、OXOYOZO到OXMYMZM、从OXMYMZM到OXIYIZI的方向余弦矩阵CTo、CoM、CMI分别为CTO=cos(θz)sin(θz)0-sin(θz)cos(θz)0001,Com=cos(θy)0-sin(θy)010sin(θy)0cos(θy),Cmi=1000cos(θx)sin(θx)0-sin(θx)cos(θx)---(13)]]>陀螺各轴感受的角速度分量为ωxωyωz=CMlCOM00Ω+CMl0Ω0+Ω00=-Ωsin(θy)Ωsin(θx)cos(θy)+Ωcos(θx)Ωcos(θx)cos(θy)-Ωsin(θx)---(14)]]>当转台内框输入角运动 中框YM及外框ZO以匀速率 运行时，θx＝θx0。陀螺各轴感受的角速率分量为ωxωyωz=-Ωsin(Ωt+θy0)Ωsin(θx0)cos(θy0+Ωt)+Ωcos(θx0)Ωcos(θx0)cos(Ωt+θy0)-Ωsin(θx0)---(15)]]>陀螺各轴感受的角加速度分量为 利用步骤2和步骤3标定出的陀螺动态误差系数补偿两组试验下陀螺输出，计算出陀螺与角加速度有关误差函数 将式(16)代入式(17)中可得 -Dx′Ω2cos(Ωt+θy0)-Dy′Ω2sin(θx0)sin(Ωt+θy0)-Dz′Ω2cos(θx0)sin(Ωt+θy0)=]]>-Dx′Ω2cos(Ωt+θy0)-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))sin(Ωt+θy0)=]]>Acos(Ωt+θy0)+Bsin(Ωt+θy0)]]>(18)A＝-Dx′Ω2(19)B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))(20)对陀螺与角加速度误差数据进行谐波分析，可分离出信号的正弦分量和余弦分量，进而求得正弦分量的振幅A和余弦分量的振幅B。
第一组试验情况下，根据θx0＝90°，θy0＝0°和θz0＝0°，A＝-Dx′Ω2以及B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))可计算得Dx′＝-A1/Ω2(21)Dz′＝-B1/Ω2(22)式中A1、B1分别为第一组试验数据谐波分析得到的正弦分量振幅和余弦分量振幅。第二组试验情况下，根据θx0＝0°，θy0＝0°和θz0＝0°，A＝-Dx′Ω2以及B＝-(Dy′Ω2sin(θx0)+Dz′Ω2cos(θx0))可计算得Dy′＝-B2/Ω2(23)式中B2为第二组试验数据谐波分析得到的余弦分量振幅。
通过三轴速率试验，由公式(2)、(3)、(4)计算陀螺标度因数Dz、安装误差系数Dx、Dy，由公式(5)、(6)、(7)和(8)分别标定出陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz以及陀螺零偏Df；通过三耦合方位动态试验，由公式(9)、(10)和(11)分别标定出陀螺三个与角速度耦合二次有关项误差系数Dxy、Dyz、Dzx；通过角加速度误差标定试验，由公式(21)、(22)和(23)分别标定出陀螺与角加速度有关项误差系数Dx′、Dy′、Dz′。至此完成了捷联MEMS陀螺所有动态误差系数的标定工作。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
权利要求
1.一种捷联MEMS陀螺动态误差标定方法，其特征在于包括以下步骤(1)根据MEMS陀螺工作原理以及误差机理推导出动态误差模型为 Dyzωyωz+Dzxωzωx+Dxxωx2+Dyyωy2+Dzzωz2+ϵ]]>式中ω为陀螺输出，°/s； 分别为沿陀螺X轴、Y轴和Z轴的角加速度分量，rad/s2；ωx、ωy、ωz分别为沿陀螺X轴、Y轴和Z轴的角速度分量，rad/s；Df为陀螺零偏；Dx′、Dy′、Dz′分别为相应的与角加速度有关项误差系数，(°/s)/(rad/s2)；Dx、Dy分别为安装误差系数，(°/s)/(rad/s)；Dz为标度因数；Dxy、Dyz、Dzx为与角速度耦合二次有关项误差系数，(°/s)/(rad/s)2；Dxx、Dyy、Dzz分别为与角速度平方有关项误差系数，(°/s)/(rac/s)2；ε为陀螺随机误差，°/s；(2)利用三轴速率转台进行三轴速率试验，标定出捷联MEMS陀螺零偏Df、标度因数Dz、安装误差系数Dx、Dy以及陀螺与角速度平方有关项误差系数Dxx、Dyy、Dzz；(3)采用三耦合方位动态试验，标定出陀螺三个与角速度耦合二次有关项误差系数Dxy、Dyz、Dzx；(4)利用三轴速率转台的速率功能，进行角加速度误差标定试验，标定陀螺三个与角加速度有关项误差系数Dx′、Dy′、Dz′。
2.根据权利要求1所述的一种捷联MEMS陀螺动态误差标定方法，其特征在于所述的步骤(3)中三耦合方位分别指陀螺坐标系OXYZ与三轴速率转台的台基坐标系OXTYTZT重合，设置转台内框XI轴初始角为φXI， 中框YM轴和外框ZO轴初始角均为0°，设置转台中框YM初始角为φYM， 内框XI轴和外框ZO轴初始角均为0°以及设置转台内框XI初始角为90°，中框YM轴初始角为φYM， 及外框ZO轴初始角均为0°三个方位。
3.根据权利要求1所述的一种捷联MEMS陀螺动态误差标定方法，其特征在于所述的步骤(4)中角加速度误差标定试验包括两组试验，第一组试验设置转台内框XI初始角θx0＝0°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴转台中框YM轴以及外框ZO轴输入相同转速Ω，5°/s＜Ω＜200°/s；第二组试验设置转台内框XI初始角θx0＝90°，中框YM轴初始角θy0＝0°和外框ZO轴初始角θz0＝0°，将三轴转台中框YM轴以及外框ZO轴输入相同转速Ω，其中5°/s＜Ω＜200°/s。
全文摘要
一种捷联MEMS陀螺动态误差标定方法，可辨识出捷联MEMS陀螺全部动态误差系数，其方法为基于MEMS陀螺误差机理，建立完备动态误差模型，利用三轴速率转台设计三轴速率试验，标定出捷联MEMS陀螺零偏、标度因数、安装误差系数以及陀螺与角速度平方有关项误差系数；采用三耦合方位动态试验，标定出陀螺三个角速度耦合二次项误差系数；利用三轴速率转台的速率功能，设置三轴初始角，将三轴转台中框Y
文档编号G01C19/00GK101029833SQ200710064319
公开日2007年9月5日 申请日期2007年3月12日 优先权日2007年3月12日
发明者房建成, 李建利, 张霄, 孙宏伟, 张海鹏 申请人:北京航空航天大学