专利名称：：无陀螺捷联惯导系统的初始姿态快速测量方法
技术领域：
：本发明提供的是一种无陀螺捷联惯导系统的初始姿态快速测量方法。(二)
背景技术：
：捷联惯导系统一般使用加速度计敏感线加速度，陀螺仪敏感载体的角速度。但机械陀螺存在抗冲击能力差的弱点，无法应用于低成本无人飞行器这种有大过载、大角加速度的载体。光学陀螺(光纤陀螺和激光陀螺)具有较大的动态范围，但光学陀螺捷联惯导系统的装备会提高低成本无人飞行器的制造成本，并降低了捷联惯导系统的可靠性。无陀螺捷联惯导系统使用加速度计代替陀螺仪，从加速度计测量的比力中解算出载体的角速度，进而只用加速度计来完成载体导航参数的测量。无陀螺捷联惯导系统的特点包括1、成本低由于不使用结构复杂、加工难度大、维护困难的陀螺，所以无陀螺捷联惯导系统成本较低。2、能耗小加速度计同陀螺相比，没有高速旋转体，所以功耗小，且不需要复杂的电源。3、动态范围大对于有陀螺捷联惯导系统而言，陀螺直接安装在载体上，高机动状态时，要求陀螺有很大的动态测量范围，这在工程上实现起来比较困难。而加速度计的测量范围大，能够满足大动态范围的要求。4、反应快无论是机械陀螺，还是光学陀螺从启动到正常工作都需要较长起动时间，故反应较慢。5、可靠性高陀螺的组成零件较多且结构复杂，加速度计组成零件少且结构简单。由无陀螺捷联惯导系统的特点可以看出无陀螺捷联惯导系统避开了机械陀螺捷联惯导系统因机械陀螺的动态范围限制所引起难题。同时，加速度计比较光学陀螺而言价格要低廉的多，高精度的加速度计大概两万元左右，因此使用加速度计的无陀螺捷联惯导系统成本比较光学陀螺捷联惯导系统低很多，使得配备无陀螺捷联惯导系统的低成本无人飞行器适合于大批量生产。无陀螺捷联惯导系统在进入导航工作状态以前需要确定初始姿态参数。初始姿态参数的测量精度直接关系到无陀螺捷联惯导系统导航的精度，初始姿态参数的测量过程所需要的时间长短决定了无陀螺捷联惯导系统导航的反应时间。实际工程中要求低成本无人飞行器具有快速反应能力和精确制导以保证其在良好的性能。低成本无人飞行器的反应时间主要取决于无陀螺捷联惯导系统初始姿态参数测量所用时间。同时，低成本无人飞行器的精确制导能力与无陀螺捷联惯导系统初始姿态参数的测量精度密切相关。因此，利用低成本无人飞行器的装载机构上惯导输出的导航信息与加速度计输出信息快速、准确地测量无陀螺捷联惯导系统的初始姿态，对于提高无陀螺捷联惯导系统的性能，从而提高低成本无人飞行器的快速反应能力具有实用价值。
发明内容本发明的目的在于提供一种能快速测量低成本无人飞行器的初始姿态，提高低成本无人飞行器的快速反应能力，具有实用价值的无陀螺捷联惯导系统的初始姿态快速测量方法。本发明的目的是这样实现的将低成本无人飞行器上的无陀螺捷联惯性导航系统作为子惯导系统，低成本无人飞行器装载机构上的捷联惯性导航系统作为主惯导系统，按照下列步骤测量初始姿态步骤1、将低成本无人飞行器上的无陀螺捷联惯性导航系统与高精度的低成本无人飞行器装载机构上的捷联惯性导航系统通过数据传输电缆相联通；步骤2、无陀螺捷联惯性导航系统进行预热后，采集加速度计输出的数据；步骤3、利用主惯导系统将初始速度参数和包括初始的经度、纬度的初始位置参数装订至无陀螺捷联惯性导航系统导航计算机中；步骤4、将主惯导系统输出的包括纵摇角、横摇角和航向角的姿态测量信息通过数据传输电缆传输至无陀螺捷联惯性导航系统，粗略测量出低成本无人飞行器的初始姿态，完成初始姿态的一次快速传递；步骤5、无陀螺捷联惯性导航系统由步骤3和步骤4得到的姿态初始值，利用无陀螺捷联惯性导航系统上加速度计输出测量低成本无人飞行器的比力信息，再由比力解算出低成本无人飞行器的角速度信息；步骤6、在子惯导系统中，利用低成本无人飞行器的比力信息与角速度信息进行导航递推解算，测量出低成本无人飞行器的速度值；步骤7、将主惯导系统测量的速度与子惯导系统测量的速度作差，并将差值作为观测向量，采用卡尔曼滤波技术估测出主惯导系统与子惯导系统之间的水平方向安装偏差4X、4y;估测时间为120秒，其中前80秒为滤波估测稳定时间，由80秒到120秒应用平均滤波技术对于数据进行平滑处理；-，一+綱一+綱xTV^(1)……+綱……+律)-其中&("、《,(yt)表示由80秒到120秒数据平滑过程中，第k个滤波估测时间点的滤波估测值；在80秒到120秒数据平滑过程中，共有N个滤波估测时间点，即k=1N;步骤8、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差ck、小y，以及子惯导系统测量比力值../;,L了'，主惯导上系统测量比力值yz了测量出主惯导系统与子惯导系统之间的方位安装偏差t;A=arcsm([+&2)其中参数、，k2，k3，k4为A《<formula>formulaseeoriginaldocumentpage7</formula>步骤9、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差以及步骤8测量出主惯导系统与子惯导系统之间的方位安装偏差4Z构造出安装<formula>formulaseeoriginaldocumentpage7</formula>偏差方向余弦矩阵<formula>formulaseeoriginaldocumentpage7</formula>步骤10、利用步骤8构造的主惯导系统与子惯导系统之间的安装偏差矩阵Csm，以及主惯导输出的方向余弦矩阵c;n构造出低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵(;n;<formula>formulaseeoriginaldocumentpage7</formula>步骤11、由低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵csn测量出无人飞行器准确的初始姿态角。本发明还可以包括如下特征1、步骤7中所用到的系统状态方程和量测方程如下<formula>formulaseeoriginaldocumentpage7</formula>选取系统的状态变量为<formula>formulaseeoriginaldocumentpage7</formula>其中Sv为主惯导系统与子惯导系统之间的速度差值；小为主惯导系统与子惯导系统之间真实的安装偏差角；cK为利用主、子惯导系统输出，实际测量得到的主、子惯导系统之间的安装偏差角；下角标x、y、z表示投影所在坐标系三个轴，此处分别为导航坐标系n系的东向轴、北向轴和天向轴；系统的状态矩阵为<formula>formulaseeoriginaldocumentpage7</formula>其中4=0-(2ofesin丄+V'0其中Re为地球半径，L为当地的讳度，量的速度；—一P—/■'，一ix/坊jz凡为地球自转角速度；vx为主惯导系统测4-r一—/"'、'广'乂//u'7却乂/k一-0_—I0一-l0射力Ll为子惯导系统测量比力值；J1为利用无陀螺捷联惯性导航系统上加速度计输出比力;量信息解算出的角速度信息；系统的量测向量为Z=["xSVy]T系统的观测矩阵为10000000010000002、无陀螺捷联惯性导航系统的无陀螺捷联惯性导航系统的三个坐标轴与低成本无人飞行器载体坐标系的三个坐标轴相重合。本发明提供了一种能快速测量低成本无人飞行器的初始姿态，从而提高低成本无人飞行器的快速反应能力，具有实用价值的无陀螺捷联惯导系统初始姿态测量方法。本发明将低成本无人飞行器上的无陀螺捷联惯性导航系统作为子惯导系统，低成本无人飞行器装载机构上的捷联惯性导航系统作为主惯导系统。利用主惯导输出的速度参考信息进行滤波，估测出主惯导系统与子惯导系统之间的水平方向安装偏差，再利用无陀螺捷联惯性导航系统中的加速度计输出信息对主惯导系统与子惯导系统之间的方位安装偏差进行匹配测量。本发明的技术具有以下优点利用低成本无人飞行器的装载机构上捷联惯导输出的导航信息与加速度计输出信息，在保证对准精度的情况下，在短时间内测量出无陀螺捷联惯导系统的初始姿态。保证了低成本无人飞行器的快速反应速度。对本发明的有益效果通过如下方法得以验证高动态条件下，低成本无人飞行器上无陀螺捷联惯导系统初始姿态测量试验。在试验中低成本无人飞行器的装载机构设置为飞机。试验条件包括(1)低成本无人飞行器的器件精度，即加速度计的随机常值偏置为0.OOOlg。(2)飞机的飞行速率为150米/秒，并且绕方位轴作40秒为周期的正弦摇摆运动。(3)飞机与低成本无人飞行器载体坐标系之间的水平方向安装偏差(K=小￥=0.28度，飞机与低成本无人飞行器载体坐标系之间的方位安装偏差4Z=1度。试验结果估测时间从开始到80秒，按照步骤7主惯导系统与子惯导系统之间的水平方向安装偏差4X、4y的滤波估测趋于稳定。估测时间从80秒到100秒应用平均滤波技术对于数据进行平滑处理，并按照步骤8测量出主惯导系统与子惯导系统之间的方位安装偏差4Z。主惯导系统与子惯导系统之间的水平方向安装偏差cK、小y的滤波估测效果如图1、图2所示。主惯导系统与子惯导系统之间的方位安装偏差的滤波估测效果如图3所示。由图可知本发明的测量值与理论设定值基本一致，同时估测速度快，可以保证低成本无人飞行器的快速反应的要求。(四)图1为本发明的主惯导系统与子惯导系统之间的水平x方向安装偏差cK的滤波估测曲线图。图2为本发明的主惯导系统与子惯导系统之间的水平y方向安装偏差小y的滤波估测曲线图。图3为本发明的主惯导系统与子惯导系统之间的z方向方位安装偏差cK的估测曲线图。(五)具体实施例方式下面结合附图举例对本发明做更详细地描述本实施方式中，将低成本无人飞行器上的无陀螺捷联惯性导航系统作为子惯导系统，低成本无人飞行器装载机构上的捷联惯性导航系统作为主惯导系统。初始姿态快速测量的具体实施步骤如下步骤1、将低成本无人飞行器上的无陀螺捷联惯性导航系统与高精度的低成本无人飞行器装载机构上的捷联惯性导航系统通过数据传输电缆相联通，使子惯导与主惯导之间的导航信息数据传输通畅。步骤2、无陀螺捷联惯性导航系统进行预热，然后采集加速度计输出的数据。预热时间根据具体系统设定。步骤3、利用主惯导系统将初始速度参数和初始位置参数(包括初始的经度、纬度)装订至无陀螺捷联惯性导航系统导航计算机中。步骤4、将主惯导系统输出的姿态测量信息(包括纵摇角、横摇角和航向角)通过数据传输电缆传输至无陀螺捷联惯性导航系统，粗略测量出低成本无人飞行器的初始姿态，完成初始姿态的一次快速传递。步骤5、无陀螺捷联惯性导航系统由步骤3(装订初始速度参数和初始位置参数)和步骤4(初始姿态的一次快速传递)得到的姿态初始值，利用无陀螺捷联惯性导航系统上加速度计输出测量低成本无人飞行器的比力信息，再由比力解算出低成本无人飞行器的角速度信息。步骤6、在子惯导系统中，利用低成本无人飞行器的比力信息与角速度信息进行导航递推解算，测量出低成本无人飞行器的速度值；步骤7、将主惯导系统测量的速度与子惯导系统测量的速度作差，并将差值作为观测向量，采用卡尔曼滤波技术估测出主惯导系统与子惯导系统之间的水平方向安装偏差中。、中，；估测时间为120秒，其中前80秒为滤波估测稳定时间，由80秒到120秒应用平均滤波技术对于数据进行平滑处理；<formula>formulaseeoriginaldocumentpage10</formula><formula>formulaseeoriginaldocumentpage10</formula>其中戎(k)、万，(尼)表示由80秒到120秒数据平滑过程中，第k个滤波估测时间点的滤波估测值；在80秒到120秒数据平滑过程中，共有N个滤波估测时间点，即k—l～N；步骤8、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差中。、中，，以及子惯导系统测量比力值矗=1厂纛厂0∥乏l。，主惯导上系统测量比力值。硝=l，嚣厂嚣∥￡1测量出主惯导系统与子惯导系统之间的方位安装偏差中。；~z=arcsin(告警)其中参数k。，k。，k。，k4为k1=厂ih…xk2=。穰呦87，岛=塑篙业一．r、sin审xflnlz一‰k4=—二兰竺半COS驴、，!垫垒!垫垒堡牟cos~xC0s办sin~ysin吮siIl丸髭．cos~~cos~~步骤9、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差中。、中，，以及步骤8测量出主惯导系统与子惯导系统之间的方位安装偏差中，构造出安装偏差方向余弦矩阵C。“；<formula>formulaseeoriginaldocumentpage10</formula>步骤10、利用步骤8构造的主惯导系统与子惯导系统之间的安装偏差矩阵C。“，以及主惯导输出的方向余弦矩阵C。“构造出低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵C。“；c=CilC1；步骤11、由低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵C。“测量出无人飞行器准确的初始姿态角。步骤7中所用到的系统状态方程和量测方程如下』<formula>formulaseeoriginaldocumentpage10</formula>(J)(J)(J)(J)(J)]Tymvymzyxyvz」选取系统的状态变量为X=[SvSv4)其中Sv为主惯导系统与子惯导系统之间的速度差值；小为主惯导系统与子惯导系统之间真实的安装偏差角；cK为利用主、子惯导系统输出，实际测量得到的主、子惯导系统之间的安装偏差0096]0097]0098]0099]0100]0101]角；0102]下角标x、y、z表示投影所在坐标系三个轴，此处分别为导航坐标系n系的东向轴、北向轴和天向轴；0103]系统的状态矩阵为—44_(J=o3x2—o3x2o3x3—0105]其中0106]4=o-(2fi紐sin丄+v'，11)凡00107]其中&为地球半径，L为当地的纬度，t的速度；■,.，,,，/\，一IX—,妙tan丄为地球自转角速度；Vx为主惯导系统测4=v''一_Xa>-f，/"'，-0一a=0.—0射为子惯导系统测量比力值；J1为利用无陀螺捷联惯性导航系统上加速度计输出比力；0112]0113]0114]0115]//量信息解算出的角速度信息；系统的量测向量为Z=["xSVy]T系统的观测矩阵为10000000—010000000116]无陀螺捷联惯性导航系统的安装应保证无陀螺捷联惯性导航系统的三个坐标轴与低成本无人飞行器载体坐标系的三个坐标轴相重合(通过安装时的光学标校来保证)。因此测量无陀螺捷联惯性导航系统的初始姿态就是测量低成本无人飞行器的初始姿态。1权利要求一种无陀螺捷联惯导系统的初始姿态快速测量方法，其特征是包括如下步骤步骤1、将低成本无人飞行器上的无陀螺捷联惯性导航系统与高精度的低成本无人飞行器装载机构上的捷联惯性导航系统通过数据传输电缆相联通；步骤2、无陀螺捷联惯性导航系统进行预热后，采集加速度计输出的数据；步骤3、利用主惯导系统将初始速度参数和包括初始的经度、纬度的初始位置参数装订至无陀螺捷联惯性导航系统导航计算机中；步骤4、将主惯导系统输出的包括纵摇角、横摇角和航向角的姿态测量信息通过数据传输电缆传输至无陀螺捷联惯性导航系统，粗略测量出低成本无人飞行器的初始姿态，完成初始姿态的一次快速传递；步骤5、无陀螺捷联惯性导航系统由步骤3和步骤4得到的姿态初始值，利用无陀螺捷联惯性导航系统上加速度计输出，测量低成本无人飞行器的比力信息，再由比力解算出低成本无人飞行器的角速度信息；步骤6、在子惯导系统中，利用低成本无人飞行器的比力信息与角速度信息进行导航递推解算，测量出低成本无人飞行器的速度值；步骤7、将主惯导系统测量的速度与子惯导系统测量的速度作差，并将差值作为观测向量，采用卡尔曼滤波技术估测出主惯导系统与子惯导系统之间的水平方向安装偏差φx、φy；估测时间为120秒，其中前80秒为滤波估测稳定时间，由80秒到120秒应用平均滤波技术对于数据进行平滑处理；<mrow><msub><mi>φ</mi><mi>x</mi></msub><mo>=</mo><mfrac><mrow><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>x</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>x</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>x</mi></msub><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow><mrow><msub><mi>φ</mi><mi>y</mi></msub><mo>=</mo><mfrac><mrow><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>y</mi></msub><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>y</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msub><mover><mi>φ</mi><mo>~</mo></mover><mi>y</mi></msub><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow>其中表示由80秒到120秒数据平滑过程中，第k个滤波估测时间点的滤波估测值；在80秒到120秒数据平滑过程中，共有N个滤波估测时间点，即k＝1～N；步骤8、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差φx、φy，以及子惯导系统测量比力值主惯导上系统测量比力值测量出主惯导系统与子惯导系统之间的方位安装偏差φz；<mrow><msub><mi>φ</mi><mi>z</mi></msub><mo>=</mo><mi>arcsin</mi><mrow><mo>(</mo><mfrac><mrow><msub><mi>k</mi><mn>1</mn></msub><msub><mi>k</mi><mn>4</mn></msub><mo>+</mo><msub><mi>k</mi><mn>3</mn></msub><msub><mi>k</mi><mn>2</mn></msub></mrow><mrow><msup><msub><mi>k</mi><mn>1</mn></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>k</mi><mn>2</mn></msub><mn>2</mn></msup></mrow></mfrac><mo>)</mo></mrow></mrow>其中参数k1，k2，k3，k4为<mrow><msub><mi>k</mi><mn>1</mn></msub><mo>=</mo><msubsup><mi>f</mi><mi>ibx</mi><mi>m</mi></msubsup></mrow><mrow><msub><mi>k</mi><mn>2</mn></msub><mo>=</mo><msubsup><mi>f</mi><mi>iby</mi><mi>m</mi></msubsup></mrow><mrow><msub><mi>k</mi><mn>3</mn></msub><mo>=</mo><mfrac><mrow><msubsup><mi>f</mi><mi>ibx</mi><mi>s</mi></msubsup><mo>+</mo><mi>sin</mi><msub><mi>φ</mi><mi>y</mi></msub><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>y</mi></msub><msubsup><mi>f</mi><mi>ibz</mi><mi>m</mi></msubsup></mrow><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>y</mi></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>y</mi></msub><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>x</mi></msub><msubsup><mi>f</mi><mi>iby</mi><mi>s</mi></msubsup></mrow><mrow><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>x</mi></msub><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>y</mi></msub></mrow></mfrac><mo>+</mo><mfrac><mrow><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>y</mi></msub><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>x</mi></msub><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>x</mi></msub><msubsup><mi>f</mi><mi>ibz</mi><mi>m</mi></msubsup></mrow><mrow><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>x</mi></msub><mi>cos</mi><msub><mi>φ</mi><mi>y</mi></msub></mrow></mfrac><mo>;</mo></mrow><mrow><msub><mi>k</mi><mn>4</mn></msub><mo>=</mo><mfrac><mrow><msub><mrow><mi>sin</mi><mi>φ</mi></mrow><mi>x</mi></msub><msubsup><mi>f</mi><mi>ibz</mi><mi>m</mi></msubsup><mo>-</mo><msubsup><mi>f</mi><mi>iby</mi><mi>s</mi></msubsup></mrow><msub><mrow><mi>cos</mi><mi>φ</mi></mrow><mi>x</mi></msub></mfrac></mrow>步骤9、利用步骤7估测出主惯导系统与子惯导系统之间的水平方向安装偏差φx、φy，以及步骤8测量出主惯导系统与子惯导系统之间的方位安装偏差φz构造出安装偏差方向余弦矩阵Csm；<mrow><msubsup><mi>C</mi><mi>s</mi><mi>m</mi></msubsup><mo>=</mo><mfencedopen='('close=')'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><msub><mi>φ</mi><mi>z</mi></msub></mtd><mtd><mo>-</mo><msub><mi>φ</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mrow><mo>-</mo><mi>φ</mi></mrow><mi>z</mi></msub></mtd><mtd><mn>1</mn></mtd><mtd><msub><mi>φ</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>φ</mi><mi>y</mi></msub></mtd><mtd><mo>-</mo><msub><mi>φ</mi><mi>x</mi></msub></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>步骤10、利用步骤8构造的主惯导系统与子惯导系统之间的安装偏差矩阵Csm，以及主惯导输出的方向余弦矩阵Cmn构造出低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵Csn；<mrow><msubsup><mi>C</mi><mi>s</mi><mi>n</mi></msubsup><mo>=</mo><msubsup><mi>C</mi><mi>m</mi><mi>n</mi></msubsup><msubsup><mi>C</mi><mi>s</mi><mi>m</mi></msubsup><mo>;</mo></mrow>步骤11、由低成本无人飞行器的载体坐标系与导航坐标系之间的方向余弦矩阵Csn测量出无人飞行器的初始姿态角。2.根据权利要求i所述的无陀螺捷联惯导系统的初始姿态快速测量方法，其特征是步骤7中所用到的系统状态方程和量测方程如下i^股选取系统的状态变量为<formula>formulaseeoriginaldocumentpage3</formula>其中Sv为主惯导系统与子惯导系统之间的速度差值；小为主惯导系统与子惯导系统之间真实的安装偏差角；小m为利用主、子惯导系统输出，实际测量得到的主、子惯导系统之间的安装偏差角；下角标x、y、z表示投影所在坐标系三个轴，此处分别为导航坐标系n系的东向轴、北向轴和天向轴；系统的状态矩阵为<formula>formulaseeoriginaldocumentpage3</formula>其中&为地球半径，L为当地的纬度，为地球自转角速度；vx为主惯导系统测量的速度；<formula>formulaseeoriginaldocumentpage3</formula>其中/:./;,;:，丁为子惯导系统测量比力值；<formula>formulaseeoriginaldocumentpage4</formula>其中"ib二["ibx"iby"信息解算出的角速度信息；系统的量测向量为Z=["xSVy]T系统的观测矩阵为一l0000000100000Z]T为利用无陀螺捷联惯性导航系统上加速度计输出比力3.根据权利要求1或2所述的无陀螺捷联惯导系统的初始姿态快速测量方法，其特征是无陀螺捷联惯性导航系统的三个坐标轴与无人飞行器载体坐标系的三个坐标轴相重合。全文摘要本发明提供的是一种无陀螺捷联惯导系统初始姿态快速测量方法。将低成本无人飞行器上的无陀螺捷联惯性导航系统作为子惯导系统，低成本无人飞行器装载机构上的捷联惯性导航系统作为主惯导系统。利用主惯导输出的速度参考信息进行滤波，估测出主惯导系统与子惯导系统之间的水平方向安装偏差，再利用无陀螺捷联惯性导航系统中的加速度计输出信息对主惯导系统与子惯导系统之间的方位安装偏差进行匹配测量。本发明能快速测量低成本无人飞行器的初始姿态，从而提高低成本无人飞行器的快速反应能力，具有实用价值，本发明适用于低成本无人飞行器配备的中高精度无陀螺捷联惯导系统。文档编号G01C21/16GK101694389SQ20091007307公开日2010年4月14日申请日期2009年10月20日优先权日2009年10月20日发明者于飞,周广涛,奔粤阳,孙枫,李倩,高伟申请人:哈尔滨工程大学;