发明名称 一种飞行中惯性初始基准偏差补偿方法
摘要 本发明提供了一种飞行中惯性初始基准偏差补偿方法,该方法利用估计得到的惯性初始基准失准角,计算飞行中当前时刻的俯仰角偏差、偏航角偏差和滚动角偏差,结合姿控修正能力采用线性规律对姿态偏差进行补偿。经数学仿真技术和搭载飞行试验验证飞行中惯性初始基准偏差补偿方法能够有效地补偿惯性基准偏差,达到提高导航系统的精度和可靠性的目的。
申请公布号 CN106595649A 申请公布日期 2017.04.26
申请号 CN201611048884.3 申请日期 2016.11.22
申请人 北京航天自动控制研究所;中国运载火箭技术研究院 发明人 周姜滨;张华明;周峰;林平;郑春胜;禹春竹;包一鸣;李硕;杨广慧
分类号 G01C21/16(2006.01)I;G01C25/00(2006.01)I 主分类号 G01C21/16(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 范晓毅
主权项 一种飞行中惯性初始基准偏差补偿方法,其特征在于包括以下步骤:(1)、根据估计得到的惯性初始基准失准角,计算导弹在飞行中的俯仰角偏差<img file="FDA0001159082090000011.GIF" wi="91" he="54" />偏航角偏差δψ和滚动角偏差δγ,具体计算公式如下:<img file="FDA0001159082090000012.GIF" wi="845" he="69" /><img file="FDA0001159082090000013.GIF" wi="774" he="71" /><img file="FDA0001159082090000014.GIF" wi="534" he="68" />其中:<img file="FDA0001159082090000015.GIF" wi="62" he="47" />γ分别为惯导系统提供的俯仰角、滚动角;φ<sub>x0</sub>、φ<sub>y0</sub>、φ<sub>z0</sub>分别为估计得到的导弹在惯性坐标系下的X向初始基准失准角、Y向初始基准失准角、Z向初始基准失准角;(2)、在设定的修正周期内,对导弹姿态偏差连续修正N拍,其中,第n拍的修正过程如下:(2a)、计算修正后的姿态矢量:<img file="FDA0001159082090000016.GIF" wi="486" he="222" />其中:<img file="FDA0001159082090000017.GIF" wi="77" he="63" />ψ<sub>n</sub>′、γ<sub>n</sub>′分别为第n拍修正后俯仰角、偏航角和滚动角;<img file="FDA0001159082090000018.GIF" wi="77" he="46" />ψ<sub>n</sub>、γ<sub>n</sub>分别为惯导系统在第n拍输出俯仰角、偏航角和滚动角;<img file="FDA0001159082090000019.GIF" wi="670" he="167" />δα<sub>z</sub>为设定的俯仰方向姿控最大修正值、δα<sub>y</sub>为设定的偏航方向姿控最大修正值、δα<sub>x</sub>为设定的滚动方向姿控最大修正值;(2b)、将第n拍修正后的姿态矢量<img file="FDA00011590820900000110.GIF" wi="106" he="222" />输出给惯导系统,惯导系统利用所述姿态矢量<img file="FDA00011590820900000111.GIF" wi="102" he="221" />进行递推计算后,输出第n+1拍的俯仰角<img file="FDA00011590820900000112.GIF" wi="108" he="47" />偏航角ψ<sub>n+1</sub>和滚动角γ<sub>n+1</sub>;其中,n=1、2、…、N。
地址 100854 北京市海淀区北京142信箱402分箱