本发明专利技术属于惯性导航技术领域，具体涉及到一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构。目的是提高惯导系统的对准精度以及长航时导航精度。本方法包括：步骤(S1)建立一个双轴旋转机构，使惯性测量单元的任意两个轴向与双轴旋转机构的两个旋转轴平行，且旋转轴的旋转是连续的；步骤(S2)控制旋转机构旋转，进行初始对准，得到初始姿态矩阵的误差；步骤(S3)使旋转机构双轴同时旋转，进行惯性导航，得到运载体坐标系内的姿态矩阵。通过构建连续旋转的双轴旋转机构，能够更好的调制惯性器件的误差，提高导航精度；通过双轴旋转调制以及姿态矩阵转换，可以得到运载体坐标系内的姿态矩阵，从而得到准确的运载体运动参数。
【技术实现步骤摘要】
本专利技术属于惯性导航
，具体涉及到一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构。
技术介绍
在进行高精度光纤捷联惯导系统的研制过程中，由于光纤陀螺漂移受温度影响比较剧烈，在恒温条件下零偏稳定性能达到0.01° /h的陀螺，在变温条件下只能达到0. 03° /h甚至更差，从而使惯导系统的导航精度仅能达到3n mile/h左右。为提高惯导系统精度，可采用单轴旋转调制技术设计惯导系统，通过绕垂向轴进行单轴旋转调制算法，抑制水平陀螺漂移的影响；利用上述惯导系统在转台上进行单轴旋 转原理验证试验，导航精度达到了 2n mile/5h ;通过误差分析可知，影响系统导航精度的主要误差源是垂向陀螺漂移。由于光纤陀螺的漂移受温度影响会有较大变化，因此，采用单轴旋转调制技术很难满足航海领域的高精度导航的需求。
技术实现思路
本专利技术的目的是提供一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构，提高惯导系统的对准精度以及长航时导航精度。本专利技术所采用的技术方案是一种光纤捷联惯导双轴旋转调制方法，包括如下步骤步骤(SI)建立一个双轴旋转机构，使惯性测量单元的任意两个轴向与双轴旋转机构的两个旋转轴平行，且旋转轴的旋转是连续的；步骤(S2)控制旋转机构旋转，进行初始对准，得到初始姿态矩阵的误差；步骤(S3)使旋转机构双轴同时旋转，进行惯性导航，得到运载体坐标系内的姿态矩阵。如上所述的一种光纤捷联惯导双轴旋转调制方法，其中所述步骤(S3)中旋转机构双轴的旋转为往复整周旋转。如上所述的一种光纤捷联惯导双轴旋转调制方法，其中所述初始对准包括粗对准和精对准两个阶段；粗对准时建立系统的初始姿态矩阵并装订初始位置和速度；精对准时估计并修正粗对准所得到的初始姿态矩阵的误差；所述精对准过程中控制旋转机构实现惯性测量单元绕自身方位轴往复旋转。如上所述的一种光纤捷联惯导双轴旋转调制方法，其中所述精对准过程中，以速度误差和位置误差为观测量，采用闭环卡尔曼滤波器来进行精对准，估计、修正初始航姿角误差。建立闭环卡尔曼滤波器时，系统状态变量为X - 'ySL^ SVn^ SVu^ 3Ve、(f)N、(^u、(pE、Vx> Ny、Vz、sx、Sy^ sz]6 L, 6 A , 6 VN> 8 Vu^ 8 VE> 4>N、4^、Ny、Vz、e x> e y、e z 依次表示讳度误差、经度误差、北速误差、天速误差、东速误差、北向误差角、方位误差角、东西误差角、二个加速度计零偏、三个陀螺漂移；在闭环卡尔曼滤波过程中，每完成一次滤波计算，进行一次闭环修正，修正量如下位置修正L = L-X⑴\ = A-X(2), L, A分别表示纬度和经度；速度修正VN= Vn-X (3)，Vu = Vu-X (4)，Ve = Ve-X (5)，Vn, Vu, Ve 分别表示北向速度、天向速度、东向速度；姿态修正G= (/ + MX])Cj5 = ，(^"分别表示姿态矩阵，小表示北向误差角、方位误差角、东西误差角组成的矢量，I表示三维单位矩阵； ^ 一t、 lh \L=L-^XJy=fy-^yJZ=L-^Z加表零偏修正」·[Vx =Vx+X(9), W x(10), Vz = Vz + X(11)fx，fy，fz分别表示三个加速度计的测量值，VxVyVz分别表示三个加速度计零偏； \(0X =0)x-sx,0) =CO-S COz =COz-Sz陀螺漂移修正W1/n[A = A + Z (12),丨=丨 + Z (13), A = A + Z (14)W z分别表示三个陀螺仪的测量值，exeyez分别表示三个陀螺漂移；X(k), k = 1,2, 14表示系统状态变量X中的元素;每次误差修正完成后,状态向量全部元素置零。如上所述的一种光纤捷联惯导双轴旋转调制方法，其中惯性导航时在运载体转弯过程中，实时获得运载体的方位变化量；然后控制惯性测量单元的方位轴朝运载体转弯的反方向旋转，并保证该旋转角度与运载体的方位变化是等量反向的。一种光纤捷联惯导双轴旋转机构，包括一个安装平台，两个相互垂直的旋转轴以及连接安装平台和旋转轴的框架；安装平台用于安装被旋转调制的装置，通过控制旋转轴或框架来实现安装平台上的装置绕旋转轴旋转。如上所述的一种光纤捷联惯导双轴旋转机构，其中所述两个相互垂直的旋转轴为内轴和外轴，所述框架包括内框与外框；内轴与安装平台固连，内轴与内框相连且内框中置有控制内轴旋转的驱动机构；外轴与内框固连，外轴与外框相连且外框中置有控制外轴旋转的驱动机构；所述安装平台用于安装惯性测量单元，惯性测量单元的任意两个轴向与旋转轴平行。本专利技术的有益效果是通过构建连续旋转的双轴旋转机构，能够更好的调制惯性器件的误差，提高导航精度；通过双轴旋转调制以及姿态矩阵转换，可以得到运载体坐标系内的姿态矩阵，从而得到准确的运载体运动参数。通过单轴旋转方式来进行初始对准，简化了运算，提高了对准精度；通过控制旋转机构的方位轴朝运载体转弯的反方向等量旋转，可以避免运载体转弯过程中陀螺刻度系数误差造成的导航误差。本专利技术提出的方法可以大大提高导航精度，能够满足水面舰艇或潜艇的导航需求，通过实验证明，采用本方法后导航精度达到2n mile/24ho缓慢变化的陀螺漂移、陀螺/加速度计的安装误差均可被完全调制掉，不再影响导航精度；外框的运动隔离作用使得陀螺刻度系数误差不再因载体的持续转弯运动而累积航向误差，从而使系统不再有造成导航误差随时间线性累积的误差；连续旋转相比转位置的调制方式可以更好的消除陀螺漂移缓慢变化的影响。附图说明图I是本专利技术提供的双轴旋转机构的结构及其与惯性测量单元的安装关系；图2是采用本专利技术的方法后的导航姿态角误差结果；图3是采用本专利技术的方法后的导航精度误差结果；其中，I.安装平台，2.内轴，3.内框，4.外轴，5.外框。具体实施方式 下面结合附图和实施例对本专利技术提供的一种光纤捷联惯导双轴旋转调制方法及一种光纤捷联惯导双轴旋转机构进行介绍实施例I :首先建立一个具有安装平台的双轴旋转机构，安装平台用于安装惯性测量单元(MU)，惯性测量单元的任意两个轴向与双轴旋转机构的旋转轴平行，且旋转轴的旋转是连续的。其次，控制旋转机构单轴或双轴同时旋转,进行初始对准,初始对准通常包括粗对准和精对准，得到初始姿态矩阵的误差。最后，使旋转机构双轴同时旋转，进行惯性导航，得到运载体坐标系内的姿态矩阵。实施例2 在实施例I的基础上，为了消除载体转弯运动造成的惯性测量单元的方位测量误差，惯性导航时在运载体转弯过程中，实时获得运载体的方位变化量；然后控制惯性测量单元的方位轴朝运载体转弯的反方向旋转，并保证该旋转角度与运载体的方位变化是等量反向的。实施例3 (SI)建立一个双轴旋转机构双轴旋转机构包括一个安装平台，两个相互垂直的旋转轴以及连接安装平台和旋转轴的框架；安装平台用于安装被旋转调制的装置，通过控制旋转轴或框架来实现安装平台上的装置绕旋转轴的旋转。一种具体实现方式如图I所示，双轴旋转机构包括相互垂直的内轴2和外轴4，内轴2与安装平台I固连，内轴2与内框3相连且内框3中置有控制内轴旋转的驱动机构，夕卜轴4与内框3固连，外轴4与外框5相连且外框5中置有控制外轴4旋转的驱动机构，外框与载体本文档来自技高网...
【技术保护点】
一种光纤捷联惯导双轴旋转调制方法，包括如下步骤：步骤（S1）建立一个双轴旋转机构，使惯性测量单元的任意两个轴向与双轴旋转机构的两个旋转轴平行，且旋转轴的旋转是连续的；步骤（S2）控制旋转机构旋转，进行初始对准，得到初始姿态矩阵的误差；步骤（S3）使旋转机构双轴同时旋转，进行惯性导航，得到运载体坐标系内的姿态矩阵。
【技术特征摘要】
【专利技术属性】
技术研发人员：徐海刚，李延，熊建琼，黄妍妍，张伟，王婷，唐彦，
申请(专利权)人：北京自动化控制设备研究所，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。