发明名称 一种基于视加速度测量的主动段程序自适应纵向制导方法
摘要 一种基于视加速度测量的主动段程序自适应纵向制导方法,根据轴向视速度增量累加和自动适应标准程序角,确保在较大的动力偏差下仍能以较高的精度按程序轨迹飞行。轴向视速度增量累加和-俯仰程序角数据表,以诸元形式装订,运载器仅依靠视加速度测量量即可生成程序指令,无需其他输入条件及复杂运算;制导指令根据实际动力水平自适应变化,无需辅助导引,从而避免了导引量分配的矛盾。在实际使用中对输入输出量均采取可靠性措施确保此发明工程应用可行。
申请公布号 CN103592946B 申请公布日期 2016.02.10
申请号 CN201310503680.4 申请日期 2013.10.23
申请人 北京航天自动控制研究所;中国运载火箭技术研究院 发明人 刘毅;包一鸣;周峰
分类号 G05D1/08(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种基于视加速度测量的主动段程序自适应纵向制导方法,其特征在于步骤如下:1)基于视加速度理论参数生成标准程序序列;11)选取运载器轴向作为视加速度测量轴;12)将预设的时间‑俯仰程序角序列代入运载器动力学模型,获得运载器的标称轨迹;根据标称轨迹,获取运载器主动段的轴向视速度增量累加和、俯仰程序角;13)将轴向视速度增量累加和‑俯仰程序角作图,根据控制精度阈值选取数表间隔,并建立轴向视速度增量累加和‑俯仰程序角数表,作为标准程序序列;14)在运载器发射准备阶段,将轴向视速度增量累加和‑俯仰程序角数表以诸元形式装订;2)根据测量得到的视加速度测量量,基于标准程序序列进行自适应制导;21)对视加速度测量量进行合理性判别并剔除野值后,获得轴向视速度增量累加和,具体方法为:211)对轴向视速度增量ΔW<sub>x1</sub>进行合理性判别,获得判别后的轴向视速度增量<img file="FDA0000798168530000011.GIF" wi="135" he="85" /><img file="FDA0000798168530000012.GIF" wi="676" he="166" />式中<img file="FDA0000798168530000013.GIF" wi="112" he="78" />为合理性判别后的轴向视速度增量,<img file="FDA0000798168530000014.GIF" wi="128" he="84" />为前一周期视速度增量<img file="FDA0000798168530000015.GIF" wi="148" he="77" />为主动段采样周期内最大视速度增量取值;212)根据步骤211)得到的判别后的轴向视速度增量<img file="FDA0000798168530000016.GIF" wi="134" he="87" />获取轴向视速度增量和<img file="FDA0000798168530000017.GIF" wi="335" he="126" />其中累计零点为发动机点火时刻;22)运载器飞行过程中,利用步骤21)获得的轴向视速度增量累加和,对轴向视速度增量累加和‑俯仰程序角数据表进行线性插值获得俯仰程序角;23)根据预设的程序角变化率幅值对步骤22)获得的俯仰程序角进行合理性判别,并以判别后的俯仰程序角指令控制运载器按预定轨迹飞行;对步骤22)获得的俯仰程序角进行合理性判别的具体方法为:231)获得俯仰程序角增量限幅值<img file="FDA0000798168530000021.GIF" wi="183" he="62" /><img file="FDA0000798168530000022.GIF" wi="756" he="230" />式中W1、W2分别为俯仰程序角速度限幅转换点对应的视速度增量累加和;<img file="FDA0000798168530000023.GIF" wi="658" he="79" />分别为各段俯仰程序角增量限幅值;232)利用俯仰程序角增量限幅值<img file="FDA0000798168530000024.GIF" wi="162" he="62" />对俯仰程序角<img file="FDA0000798168530000025.GIF" wi="70" he="71" />进行合理性判别:<img file="FDA0000798168530000026.GIF" wi="854" he="158" />式中<img file="FDA0000798168530000029.GIF" wi="92" he="62" />为前一周期俯仰程序角指令,<img file="FDA0000798168530000028.GIF" wi="65" he="55" />为基于视加速度测量的主动段程序自适应纵向制导技术得到的程序指令,即判别后的俯仰程序角指令。
地址 100076 北京市海淀区北京142信箱402分箱