专利名称：一种基于光纤捷联罗经技术的载体姿态确定方法
技术领域：
本发明涉及的是一种测量方法，尤其涉及的是一种基于光纤捷联罗经技术的载体姿态确定方法。
背景技术：
传统的陀螺罗经是最古老的以一高速旋转的陀螺为基础系统，能使它的角力矩方向与地球旋转的角力矩方向一致，就像一个磁罗盘的磁力矩与地磁场方向保持一致那样来确定地理北向相关的方位。从二十世纪二十年代起，这种陀螺罗经就一直应用于各类舰船上，这些舰船需要零点几度的航向精度并能避免磁场干扰。在过去六十年左右的时 里，这种技术在基本的原理上没有任何变化，同时在使用中它还需要非常细致的维护，且提供的可靠性也有限。陀螺罗经系统必须能承受随机运动的影响，即无论载体如何运动，陀螺罗经必须保持对外界运动相对不敏感，而且这种随机运动可能是很剧烈的，如船的翻滚、摇摆、波浪的涌动等。所以考虑实际的恶劣运动环境，我们可清楚的知道由于有翻滚、摇摆等运动的存在，陀螺所测量的地球转速受到非常大的转动量的干扰；其次，受波浪涌动、载体加减速等机动运动时，加速度计测量的重力加速度受到离心加速度和牵连加速度的干扰，且离心加速度被证明是相当高的。传统陀螺罗经系统直接利用与陀螺框架有关的地球转动速率的测量，这种做法没什么特别优势，而且系统比较复杂，不符合光纤捷联罗经系统的要求。光纤陀螺仪以其动态范围大、精度高、启动快和系统设计灵活等优点在惯性器件领域得到快速发展和应用。光纤陀螺仪可在任何设定的瞬时，测量出运动物体的旋转角速度，加速度计测量出载体的重力视加速度和其它加速度的总和。这些测量信息都与运动物体自身的参考坐标系有关的，运动载体相对于惯性空间的角姿态可通过旋转角速度的积分可计算出来。如果将载体的离心加速度和牵连加速度等剔除掉，那么在惯性坐标系内就能观察到由于地球旋转引起的重力视加速度的缓慢漂移。如果在惯性坐标系中观察重力加速度，那么其运动轨迹构成一个圆锥面，该圆锥体主轴是地球的旋转轴。因此若取重力加速度在惯性坐标系的投影，则其投影分量就能包含地球自转角速度信息，所以只需要分析重力加速度的运动便能确定地理北向信息。
发明内容
本发明的技术解决问题是克服现有技术不足，提供一种利用数字低通滤波器求取惯性坐标系下的重力加速度信息，由重力加速度在惯性系内进行投影获取载体相对地球表面的运动状态，实现对载体姿态信息实时获取的新方法。本发明的技术解决方案为一种基于光纤捷联罗经技术的载体姿态确定方法，其特征在于载体处于机动环境下，加速度计输出中包含着大量的干扰加速度，通过利用数字低通滤波器滤除载体干扰加速度后，在惯性坐标系内就能观察到由于地球旋转引起的重力视加速度的缓慢漂移，通过分析重力加速度的运动便能确定地理北向信息，以此实现对载体姿态信息的获�。北苊饬舜辰萘叩枷低城笕〉淖颂畔⒅邪胬罩芷谡鸬春透悼浦芷谡鸬次蟛疃宰颂鹊挠跋�。其具体步骤如下(I)利用全球定位系统GPS确定载体的初始位置参数，将它们装订至导航计算机中；(2)光纤陀螺捷联惯性导航系统进行预热，然后采集光纤陀螺仪和石英加速度计输出的数据；(3)对采集到的光纤陀螺仪和石英加速度计的数据进行处理；(4)将三个加速度计测量的载体加速度转换到惯性系上得到加速度~f :
权利要求
1.一种基于光纤捷联罗经技术的载体姿态确定方法，其特征在于包括以下步骤 (1)利用全球定位系统GPS确定载体的初始位置参数，将它们装订至导航计算机中； (2)光纤陀螺捷联惯性导航系统进行预热，然后采集光纤陀螺仪和石英加速度计输出的数据； (3)对采集到的光纤陀螺仪和石英加速度计的数据进行处理； (4)将三个加速度计测量的载体加速度转换到惯性系上得到加速度~r:P=CJb 其中，C〗表示载体坐标系向惯性坐标系的转换矩阵，根据陀螺仪的输出，利用四元数法对矩阵q进行实时更新，为下一周期的运算提供参数；中包含两部分重力加速度g和其他加速度(有害加速度和机动加速度)。有害加速度和机动加速度在惯性系内也将因G变化十分剧烈，变化频段处于比较高的频率；重力加速度g在惯性系内作圆锥慢漂运动(如附图
2)，变化十分缓慢，周期在20小时左右，变化频段处于比较低的频率。
(5)设计低通滤波器实现对重力加速度的获取。
设计低通滤波器，综合考虑低通特性、延时大小等因素，设定滤除加速度计信号滤波器的过渡带分别为
。
利用重力加速度信息在基座惯性系呈现出慢圆锥变化这一特性，采取低通滤波技术对惯性系下的加速度信息/'进行处理，滤除载体由于摇摆及荡运动产生的干扰角速度和加速度，得到相对纯净的重力加速度gS其获取流程如附图3。
(6)将获取的重力加速度信息f在惯性系内进行投影S、<、<，由投影进行计算得到a、3。
2.根据权利要求I所述的一种基于光纤捷联罗经技术的载体姿态确定方法，其特征在于所述的将三个加速度计测量的载体加速度/A转换到惯性系上得到加速度~r ；I1=CJb 其中，q表示载体坐标系向惯性坐标系的转换矩阵，根据陀螺仪的输出，利用四元数法对矩阵q进行实时更新，为下一周期的运算提供参数；/A中包含两部分重力加速度g和其他加速度(有害加速度和机动加速度)。有害加速度和机动加速度在惯性系内也将因G变化十分剧烈，变化频段处于比较高的频率；重力加速度g在惯性系内作圆锥慢漂运动，变化十分缓慢，周期在20小时左右，变化频段处于比较低的频率。
3.根据权利要求I所述的一种基于光纤捷联罗经技术的载体姿态确定方法，其特征在于所述的设计低通滤波器实现对重力加速度的获�。� 设计低通滤波器，综合考虑低通特性、延时大小等因素，设定滤除加速度计信号滤波器的过渡带分别为
。
利用重力加速度信息在基座惯性系呈现出慢圆锥变化这一特性，采取低通滤波技术对惯性系下的加速度信息7进行处理，滤除载体由于摇摆及荡运动产生的干扰角速度和加速度，得到相对纯净的重力加速度gi。
4.根据权利要求I所述的一种基于光纤捷联罗经技术的载体姿态确定方法，其特征在于所述的将获取的重力加速度信息f在惯性系内进行投影K、<、K，由投影进行计算得到 a、3 ;
全文摘要
本发明提供的是一种基于光纤捷联罗经技术的载体姿态确定方法。载体处于机动环境下，加速度计输出中包含着大量的干扰加速度，通过利用数字低通滤波器滤除载体干扰加速度后，在惯性坐标系内就能观察到由于地球旋转引起的重力视加速度的缓慢漂移，通过分析重力加速度的运动便能确定地理北向信息，并进一步确定出系统的姿态捷联矩阵，计算出载体任意时刻的姿态信息。本发明有效地解决了传统姿态测量方法中输出的姿态信息包含舒勒震荡周期和傅科震荡周期对系统姿态精度的影响，该方法具有自主、精度高的特点，适合用于各种中高精度的捷联惯性导航系统。
文档编号G01C21/16GK102706349SQ20121018702
公开日2012年10月3日 申请日期2012年6月6日 优先权日2012年6月6日
发明者孙伟, 徐爱功, 高扬 申请人:辽宁工程技术大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
