发明名称 一种基于GPS信息的惯性导航系统测量误差修正方法
摘要 本发明公开了一种基于GPS信息的惯性导航系统测量误差修正方法,本发明提出采用串联控制的方法,引入外部GPS位置信息、速度信息以对惯性导航误差进行修正,通过设计合适的控制器即可完成对输入信号噪声的滤除,完成系统输出对系统输入的跟踪,即完成对惯导系统速度和位置误差的修正,该方法不依赖于系统误差模型的精确性,运算速度快,时间开销短,当外测数据频率较高时也可完成对惯导系统速度和位置测量误差的修正,只需通过修改控制器参数即可重新建立系统的误差模型,工作量小。
申请公布号 CN103471593A 申请公布日期 2013.12.25
申请号 CN201310403697.2 申请日期 2013.09.06
申请人 北京航天控制仪器研究所 发明人 魏宗康;刘生炳;赵龙
分类号 G01C21/20(2006.01)I 主分类号 G01C21/20(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 臧春喜
主权项 1.一种基于GPS信息的惯性导航系统测量误差修正方法,其特征在于包括北向通道测量误差修正步骤和东向通道测量误差修正步骤:北向通道测量误差修正步骤:(1)对惯性导航系统测量的北向加速度a<sub>n</sub>进行积分获得北向速度<img file="FDA0000378652330000011.GIF" wi="76" he="71" />(2)将北向速度<img file="FDA0000378652330000012.GIF" wi="46" he="72" />与GPS获得的载体真实北向速度v<sub>n</sub>做差得到北向速度误差<img file="FDA00003786523300000123.GIF" wi="111" he="66" />即<maths num="0001"><![CDATA[<math><mrow><msub><mrow><mo>&dtri;</mo><mi>v</mi></mrow><mi>n</mi></msub><mo>=</mo><msub><mover><mi>v</mi><mo>^</mo></mover><mi>n</mi></msub><mo>-</mo><msub><mi>v</mi><mi>n</mi></msub><mo>;</mo></mrow></math>]]></maths>(3)北向速度修正环节控制器根据北向速度误差<img file="FDA00003786523300000124.GIF" wi="79" he="58" />生成纬度控制量u<sub>vn</sub>;(4)利用纬度控制量u<sub>vn</sub>对北向加速度a<sub>n</sub>进行修正,经过修正后的北向加速度a<sub>n</sub>再次进行积分得到修正后的北向速度;(5)利用<img file="FDA0000378652330000014.GIF" wi="102" he="117" />将修正后的北向速度<img file="FDA0000378652330000015.GIF" wi="56" he="72" />转化为纬度变化率<img file="FDA00003786523300000127.GIF" wi="69" he="125" /><img file="FDA0000378652330000016.GIF" wi="211" he="127" />(6)对纬度变化率<img file="FDA0000378652330000017.GIF" wi="42" he="88" />进行积分得到纬度<img file="FDA0000378652330000018.GIF" wi="76" he="71" />将纬度<img file="FDA0000378652330000019.GIF" wi="51" he="70" />与GPS获得的载体真实纬度<img file="FDA00003786523300000110.GIF" wi="40" he="57" />做差得到纬度误差<img file="FDA00003786523300000111.GIF" wi="112" he="67" />即<img file="FDA00003786523300000112.GIF" wi="272" he="66" />(7)纬度修正环节控制器根据纬度误差<img file="FDA00003786523300000113.GIF" wi="76" he="54" />生成控制量<img file="FDA00003786523300000114.GIF" wi="84" he="63" />(8)利用控制量<img file="FDA00003786523300000115.GIF" wi="48" he="53" />对纬度变化率<img file="FDA00003786523300000116.GIF" wi="42" he="84" />进行修正,经过修正后的纬度变化率<img file="FDA00003786523300000117.GIF" wi="44" he="86" />再次进行积分得到修正后的纬度<img file="FDA00003786523300000118.GIF" wi="73" he="71" />修正后的纬度<img file="FDA00003786523300000119.GIF" wi="40" he="71" />作为惯性导航系统的北向通道输出,从而完成北向通道测量误差的修正;东向通道测量误差修正步骤:(1)对惯性导航系统测量的东向加速度a<sub>e</sub>进行积分获得北向速度<img file="FDA00003786523300000120.GIF" wi="76" he="64" />(2)将东向速度<img file="FDA00003786523300000121.GIF" wi="50" he="60" />与GPS获得的载体真实东向速度v<sub>e</sub>做差得到东向速度误差<img file="FDA00003786523300000125.GIF" wi="110" he="66" />即<maths num="0002"><![CDATA[<math><mrow><mo>&dtri;</mo><msub><mi>v</mi><mi>e</mi></msub><mo>=</mo><msub><mover><mi>v</mi><mo>^</mo></mover><mi>e</mi></msub><mo>-</mo><msub><mi>v</mi><mi>e</mi></msub><mo>;</mo></mrow></math>]]></maths>(3)东向速度修正环节控制器根据东向速度误差<img file="FDA00003786523300000126.GIF" wi="81" he="61" />生成经度控制量u<sub>ve</sub>;(4)利用经度控制量u<sub>ve</sub>对东向加速度a<sub>e</sub>进行修正,经过修正后的东向加速度a<sub>e</sub>再次进行积分得到修正后的东向速度;(5)利用<img file="FDA0000378652330000021.GIF" wi="256" he="120" />将修正后的东向速度<img file="FDA0000378652330000022.GIF" wi="52" he="71" />转化为经度变化率<img file="FDA0000378652330000023.GIF" wi="73" he="77" /><img file="FDA0000378652330000024.GIF" wi="363" he="126" />(6)对经度变化率<img file="FDA0000378652330000025.GIF" wi="34" he="75" />进行积分得到经度<img file="FDA0000378652330000026.GIF" wi="64" he="73" />将经度<img file="FDA0000378652330000027.GIF" wi="45" he="71" />与GPS获得的载体真实经度λ做差得到经度误差<img file="FDA00003786523300000216.GIF" wi="99" he="59" />即<img file="FDA0000378652330000028.GIF" wi="268" he="76" />(7)经度修正环节控制器根据经度误差<img file="FDA00003786523300000217.GIF" wi="73" he="52" />生成经度控制量u<sub>λ</sub>;(8)利用经度控制量u<sub>λ</sub>对经度变化率<img file="FDA0000378652330000029.GIF" wi="38" he="71" />进行修正,经过修正后的经度变化率<img file="FDA00003786523300000210.GIF" wi="37" he="75" />再次进行积分得到修正后的经度<img file="FDA00003786523300000211.GIF" wi="68" he="73" />修正后的经度<img file="FDA00003786523300000212.GIF" wi="38" he="71" />作为惯性导航系统的东向通道输出,从而完成东向通道测量误差的修正。
地址 100854 北京市海淀区北京142信箱403分箱