发明名称 一种SINS/GPS组合导航系统的空中机动对准方法
摘要 本发明涉及一种SINS/GPS组合导航系统的空中机动对准方法,其特征是补偿了GPS观测量的杆臂效应误差,提高了观测量的精度,同时采用航向变化的机动策略,利用奇异值分解的方法分析载体机动时系统各个状态变量可观测度的变化,采用自适应反馈策略,根据可观测度的变化调节系统状态变量的反馈因子,并进行反馈校正。本发明具有精度高、不易发散的优点,可用于提高飞机、导弹、舰船或地面车辆用组合导航系统的导航精度。
申请公布号 CN1314945C 申请公布日期 2007.05.09
申请号 CN200510086790.0 申请日期 2005.11.04
申请人 北京航空航天大学 发明人 房建成;刘百奇;盛蔚;张延顺;曹娟娟;宫晓琳
分类号 G01C21/16(2006.01);G01C25/00(2006.01);G01S1/02(2006.01) 主分类号 G01C21/16(2006.01)
代理机构 北京科迪生专利代理有限责任公司 代理人 刘秀娟;成金玉
主权项 1、一种SINS/GPS组合导航系统的空中机动对准方法,其特征在于包括下列步骤:(1)首先根据IMU的测量中心与GPS天线相位中心之间的空间几何关系,建立GPS观测量杆臂效应误差补偿模型,并进行补偿,所建立的GPS观测量杆臂效应误差模型为:<maths num="001"><![CDATA[ <math><mrow><msub><mi>&Delta;V</mi><mi>n</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>b</mi><mi>n</mi></msubsup><msub><mi>&Delta;V</mi><mi>b</mi></msub><mo>=</mo><msubsup><mi>C</mi><mi>b</mi><mi>n</mi></msubsup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>&Delta;V</mi><mi>bx</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&Delta;V</mi><mi>by</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&Delta;V</mi><mi>bz</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><msubsup><mi>C</mi><mi>b</mi><mi>n</mi></msubsup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&omega;</mi><mi>nby</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>z</mi></msub><mo>-</mo><msubsup><mi>&omega;</mi><mi>nbz</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msubsup><mi>&omega;</mi><mi>nbz</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>x</mi></msub><mo>-</mo><msubsup><mi>&omega;</mi><mi>nbx</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><msubsup><mi>&omega;</mi><mi>nbx</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>y</mi></msub><mo>-</mo><msubsup><mi>&omega;</mi><mi>nby</mi><mi>b</mi></msubsup><msub><mi>r</mi><mi>x</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>其中,ΔV<sub>n</sub>为GPS观测量的杆臂效应误差,ΔV<sub>b</sub>为GPS观测量的杆臂效应误差在载体坐标系内的投影,C<sub>b</sub><sup>n</sup>为载体坐标系到导航坐标系的转换矩阵,ω<sub>nb</sub><sup>b</sup>是载体的角速度,r为IMU的测量中心与GPS天线相位中心之间的距离;(2)通过可观测度分析方法分析载体机动时系统各个状态变量可观测度的变化;(3)根据可观测度的变化,采用<img file="C2005100867900002C2.GIF" wi="438" he="68" />(i=1,Λ,15)的自适应反馈策略调节系统状态变量的反馈因子,并进行反馈校正,其中,<img file="C2005100867900002C3.GIF" wi="343" he="131" />为状态变量ΔX<sub>i</sub>的反馈权值,ΔX<sub>real</sub>(i)表示SINS/GPS组合导航系统的真实误差,<img file="C2005100867900002C4.GIF" wi="169" he="74" />表示载体机动时状态变量X可观测度最大的情况下,状态变量的最优估值;<maths num="002"><![CDATA[ <math><mrow><mi>&beta;</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mi>&sigma;</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mrow><mrow><msub><mi>&sigma;</mi><mi>opti</mi></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mrow></mfrac><mo>,</mo></mrow></math>]]></maths>为ΔX<sub>i</sub>的反馈因子,σ(i)表示状态变量ΔX(i)在某一段时间内的可观测度,σ<sub>opti</sub>(i)表示状态变量ΔX(i)的可观测度的最大值。
地址 100083北京市海淀区学院路37号