船用旋转式光纤陀螺捷联惯导系统初始对准方法.pdf

《船用旋转式光纤陀螺捷联惯导系统初始对准方法.pdf》由会员分享，可在线阅读，更多相关《船用旋转式光纤陀螺捷联惯导系统初始对准方法.pdf（12页珍藏版）》请在专利查询网上搜索。

1、10申请公布号CN101963512A43申请公布日20110202CN101963512ACN101963512A21申请号201010270840122申请日20100903G01C25/00200601G01C21/1820060171申请人哈尔滨工程大学地址150001黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室72发明人高伟李仔冰奔粤阳于飞张鑫张勇刚黄平徐博吴磊王伟54发明名称船用旋转式光纤陀螺捷联惯导系统初始对准方法57摘要本发明的目的在于提供船用旋转式光纤陀螺捷联惯导系统初始对准方法。首先采集陀螺仪输出和加速度计输出，然后控制IMU绕天向轴在45、13。

2、5、45、135的四个位置间循环运动的转位方案来进行漂移误差的自动补偿，组成旋转式惯导系统，接着建立卡尔曼滤波状态方程和量测方程，给定系统的初始值，初始对准完成。对于自身具有旋转机构的旋转式惯导系统，初始对准时可以克服惯性元件漂移对自对准的影响，提高对准精度；旋转式惯导系统通过改变系统误差模型中的捷联矩阵改善系统的可观测性，提高了系统状态参量的可估性以及估计精度。51INTCL19中华人民共和国国家知识产权局12发明专利申请权利要求书2页说明书5页附图4页CN101963513A1/2页21船用旋转式光纤陀螺捷联惯导系统初始对准方法，其特征是1将标定后的捷联惯导系统安装在单轴转台上，启动系统，。

3、采集陀螺仪输出和加速度计输出；2控制IMU绕天向轴在45、135、45、135的四个位置间循环运动的转位方案来进行漂移误差的自动补偿，组成旋转式惯导系统，设IMU在每个位置上停止相同的时间TS，令每次转动的角速度均为/TR，TR为每次旋转的时间，具体为IMU从第一点出发反转180到达第三点，停止时间TS，IMU从第三点出发反转90到达第四点，停止时间TS，IMU从第四点出发正转180到达第二点，停止时间TS，IMU从第二点出发正转90到达第一点，停止时间TS，IMU从第一点出发正转180到达第三点，停止时间TS，IMU从第三点出发正转90到达第二，停止时间TS，IMU从第二点出发反转180到达。

4、第四点，停止时间TS，IMU从第四点出发反转90到达第一点，停止时间TS，然后IMU按照上述顺序循环运动；3建立卡尔曼滤波状态方程使用一阶线性随机微分方程来描述捷联惯导系统的状态误差为其中XT为T时刻系统的状态向量，FT和GT分别为系统状态矩阵和噪声矩阵，WT为系统的噪声向量，船用捷联惯导系统不考虑高度通道，故设置系统的状态向量为XVEVNENUXYXYZT，系统的白噪声向量为WT00000AXAYXYZT，其中E、N、U分别表示纵摇、横摇和航向误差角，VE、VN分别表示东向、北向的速度误差，X、Y分别为X、Y轴加速度计的零偏，X、Y、Z分别为X、Y、Z轴陀螺的常值漂移，AX、AY分别为X、Y。

5、轴加速度计的白噪声误差，X、Y、Z分别为X、Y、Z轴陀螺的白噪声误差，系统的状态转移矩阵为系统噪声系数矩阵为GT055T55，其中权利要求书CN101963512ACN101963513A2/2页3式中G为当地重力加速度，IE为地球角速度，L为当地地理纬度，CIJI，J1，2，3为捷联矩阵中的元素，为捷联惯导系统的捷联矩阵；建立卡尔曼滤波的量测方程使用一阶线性随即微分方程来描述捷联惯导系统的量测方程为ZTHTXTVT，其中ZT表示T时刻系统的量测向量，HT表示系统的量测矩阵，VT表示系统的测量噪声，系统量测矩阵为HTI220210，量测量为其中FB表示加速度计测量值在载体坐标系的投影，表示重力。

6、加速度矢量在惯性系的积分，表示加速度计测量值在惯性系的积分；4根据卡尔曼滤波状态方程和量测方程，给定系统的初始值初始对准完成，进入导航状态。权利要求书CN101963512ACN101963513A1/5页4船用旋转式光纤陀螺捷联惯导系统初始对准方法技术领域0001本发明涉及的是一种导航领域的初始姿态对准方法。背景技术0002高精度惯导系统采用旋转自动补偿技术可以大幅度提高惯导系统的精度，因此旋转式惯导系统已成了我国船用惯性导航系统的主要研究对象。初始对准是捷联惯导系统进行导航的前提，初始对准的精度将直接影响到系统的导航精度。对于惯导系统单个位置的对准来说，对准精度直接受限于惯性元件的常值偏差。

7、大小，即无论采用经典的二阶调平回路及罗经回路对准，还是采用卡尔曼滤波技术对准，系统的水平对准误差均与系统东向和北向加速度计的常值偏差有关，特别是东向陀螺漂移引起较大的方位误差。发明内容0003本发明的目的在于提供一种通过旋转IMU提高系统状态误差的可观测性、从而提高系统的失准角以及惯性器件误差的估计精度的船用旋转式光纤陀螺捷联惯导系统初始对准方法。0004本发明的目的是这样实现的0005本发明船用旋转式光纤陀螺捷联惯导系统初始对准方法，其特征是00061将标定后的捷联惯导系统安装在单轴转台上，启动系统，采集陀螺仪输出和加速度计输出；00072控制IMU绕天向轴在45，135，45，135的四个。

8、位置间循环运动的转位方案来进行漂移误差的自动补偿，组成旋转式惯导系统，设IMU在每个位置上停止相同的时间TS，令每次转动的角速度均为/TR，TR为每次旋转的时间，具体为0008IMU从第一点出发反转180到达第三点，停止时间TS，IMU从第三点出发反转90到达第四点，停止时间TS，IMU从第四点出发正转180到达第二点，停止时间TS，IMU从第二点出发正转90到达第一点，停止时间TS，IMU从第一点出发正转180到达第三点，停止时间TS，IMU从第三点出发正转90到达第二，停止时间TS，IMU从第二点出发反转180到达第四点，停止时间TS，IMU从第四点出发反转90到达第一点，停止时间TS，然。

9、后IMU按照上述顺序循环运动；00093建立卡尔曼滤波状态方程0010使用一阶线性随机微分方程来描述捷联惯导系统的状态误差为00110012其中XT为T时刻系统的状态向量，FT和GT分别为系统状态矩阵和噪声矩阵，WT为系统的噪声向量，船用捷联惯导系统不考虑高度通道，故设置系统的状态向量为0013XVEVNENUXYXYZT，0014系统的白噪声向量为0015WT00000AXAYXYZT，说明书CN101963512ACN101963513A2/5页50016其中E、N、U分别表示纵摇、横摇和航向误差角，VE、VN分别表示东向、北向的速度误差，X、Y分别为X、Y轴加速度计的零偏，X、Y、Z分别。

10、为X、Y、Z轴陀螺的常值漂移，AX、AY分别为X、Y轴加速度计的白噪声误差，X、Y、Z分别为X、Y、Z轴陀螺的白噪声误差，系统的状态转移矩阵为00170018系统噪声系数矩阵为0019GT055T55，0020其中002100220023式中G为当地重力加速度，IE为地球角速度，L为当地地理纬度，CIJI，J1，2，3为捷联矩阵中的元素，为捷联惯导系统的捷联矩阵；0024建立卡尔曼滤波的量测方程0025使用一阶线性随即微分方程来描述捷联惯导系统的量测方程为0026ZTHTXTVT，0027其中ZT表示T时刻系统的量测向量，HT表示系统的量测矩阵，VT表示系统的测量噪声，系统量测矩阵为0028H。

11、TI220210，0029量测量为00300031其中003200330034FB表示加速度计测量值在载体坐标系的投影，表示重力加速度矢量在惯性系的积分，表示加速度计测量值在惯性系的积分；00354根据卡尔曼滤波状态方程和量测方程，给定系统的初始值初始对准完成，进入导航状态。说明书CN101963512ACN101963513A3/5页60036本发明的优势在于对于自身具有旋转机构的旋转式惯导系统，初始对准时可以克服惯性元件漂移对自对准的影响，提高对准精度；旋转式惯导系统通过改变系统误差模型中的捷联矩阵改善系统的可观测性，提高了系统状态参量的可估性以及估计精度。附图说明0037图1为旋转式惯导。

12、系统的旋转方案图；0038图2为利用MATLAB仿真得到的姿态角误差估计曲线图；0039图3为利用MATLAB仿真得到的加速度计零偏估计曲线图；0040图4为利用MATLAB仿真得到的陀螺漂移估计曲线图；0041图5为实验室静态试验得到的姿态角误差估计曲线图；0042图6为实验室静态试验得到的加速度计零偏估计曲线图；0043图7为实验室静态试验得到的陀螺漂移估计曲线图；0044图8为本发明的流程图。具体实施方式0045下面结合附图举例对本发明做更详细地描述0046结合图18，本发明船用旋转式光纤陀螺捷联惯导系统初始对准方法步骤如图8所示，具体如下00471将标定后的捷联惯导系统安装在单轴转台上。

13、，启动系统，采集陀螺仪输出和加速度计输出；00482控制IMU绕天向轴在45，135，45，135的四个位置间循环运动的转位方案来进行漂移误差的自动补偿，如图1所示，组成旋转式惯导系统，设IMU在每个位置上停止相同的时间TS，令每次转动的角速度均为/TR，TR为每次旋转的时间，具体为次序1，IMU从A点出发反转180到达位置C，停止时间TS；次序2，IMU从C点出发反转90到达位置D，停止时间TS；次序3，IMU从D点出发正转180到达位置B，停止时间TS；次序4，IMU从B点出发正转90到达位置A，停止时间TS；次序5，IMU从A点出发正转180到达位置C，停止时间TS；次序6，IMU从C点。

14、出发正转90到达位置B，停止时间TS；次序7，IMU从B点出发反转180到达位置D，停止时间TS；次序8，IMU从位置D出发反转90到达位置A，停止时间TS；然后IMU按照次序14的顺序循环运动；00493建立卡尔曼滤波状态方程0050使用一阶线性随机微分方程来描述捷联惯导系统的状态误差为00510052其中XT为T时刻系统的状态向量，FT和GT分别为系统状态矩阵和噪声矩阵，WT为系统的噪声向量，船用捷联惯导系统不考虑高度通道，故设置系统的状态向量为0053XVEVNENUXYXYZT，0054系统的白噪声向量为0055WT00000AXAYXYZT，0056其中E、N、U分别表示纵摇、横摇和。

15、航向误差角，VE、VN分别表示东向、北向的速度误差，X、Y分别为X、Y轴加速度计的零偏，X、Y、Z分别为X、Y、Z轴陀螺说明书CN101963512ACN101963513A4/5页7的常值漂移，AX、AY分别为X、Y轴加速度计的白噪声误差，X、Y、Z分别为X、Y、Z轴陀螺的白噪声误差，系统的状态转移矩阵为00570058系统噪声系数矩阵为0059GT055T55，0060其中006100620063式中G为当地重力加速度，IE为地球角速度，L为当地地理纬度，CIJI，J1，2，3为捷联矩阵中的元素，为捷联惯导系统的捷联矩阵；0064建立卡尔曼滤波的量测方程0065使用一阶线性随即微分方程来描。

16、述捷联惯导系统的量测方程为0066ZTHTXTVT，0067其中ZT表示T时刻系统的量测向量，HT表示系统的量测矩阵，VT表示系统的测量噪声，系统量测矩阵为0068HTI220210，0069量测量为00700071其中007200730074FB表示加速度计测量值在载体坐标系的投影，表示重力加速度矢量在惯性系的积分，表示加速度计测量值在惯性系的积分；00754根据卡尔曼滤波状态方程和量测方程，给定系统的初始值初始对准完成，进入导航状态。0076本发明的有益效果如下00771MATLAB仿真说明书CN101963512ACN101963513A5/5页80078在以下的仿真条件下，对该方法进行。

17、仿真实验0079捷联惯导系统作静态单轴旋转监控试验；0080载体初始位置北纬457796，东经1266705；0081载体初始姿态0，0，135；0082初始姿态误差角横摇误差角18，纵摇误差角18，方位误差角60；0083陀螺漂移三个方向轴上的陀螺常值漂移为002/H，随机漂移为001/H；0084加速度计零位偏置加速度计的零位偏置为104G，随机偏置为105G；0085赤道半径RE63783930M；0086椭球度E3367E3；0087由万有引力可得的地球表面重力加速度G0978049；0088地球自转角速度弧度/秒72921158E5；0089常数31415926。0090利用发明所述。

18、方法得到估计纵摇角、横摇角和航向角曲线如图2所示；水平加速度计零偏的估计如图3所示；陀螺漂移的估计如图4所示。图2和图3为局部放大图。结果表明采用本发明的方法可以获得较高的对准精度，还能估计出IMU水平方向上惯性器件的常值偏差。00912光纤陀螺捷惯导系统的实验室静态试验0092将自行研制的光纤陀螺捷联惯导系统放在三轴转台上进行静态试验，试验中光纤陀螺捷联惯导系统的器件精度和实验环境如下0093陀螺仪常值漂移001度/小时；0094陀螺仪白噪声误差0005度/小时；0095加速度计零偏104G；0096加速度计白噪声误差5105G；0097载体真实姿态135，0，0。0098利用发明所述方法得到在三轴转台对准实验静止状态姿态误差角曲线如图5所示；水平加速度计零偏的估计如图6所示；陀螺漂移的估计如图7所示。图5和图6为局部放大图。结果表明在该种状态下对准精度可以满足实际需要，同时能部分估计出惯性器件的常值偏差。说明书CN101963512ACN101963513A1/4页9图1图2说明书附图CN101963512ACN101963513A2/4页10图3图4说明书附图CN101963512ACN101963513A3/4页11图5图6说明书附图CN101963512ACN101963513A4/4页12图7图8说明书附图CN101963512A。