[发明专利]一种固体运载火箭椭圆转移轨道迭代制导控制方法

摘要

本发明公开了一种固体运载火箭椭圆转移轨道迭代制导控制方法，涉及制导控制技术领域，该方法包括以下步骤：预制椭圆参考轨迹数表。计算预报关机时刻固体运载火箭的速度矢量Vic和位置矢量Rec；根据Rec和椭圆参考轨迹数表，计算固体运载火箭在目标点轨道坐标系下的标准速度矢量在一个计算周期内，依次对剩余工作时间调整量ΔT、俯仰角调整量偏航程序角调整量Δψ进行迭代计算，直到ΔT、Δψ的绝对值均小于等于预设值；在剩余的每个计算周期内，继续对ΔT、和Δψ进行迭代计算，更新T、和直至剩余工作时间T小于等于预设值，保持当前俯仰程序角和偏航程序角不变，直到T为0。本发明实时性强、制导精度高、算法简单。

主权项

1.一种固体运载火箭椭圆转移轨道迭代制导控制方法，其特征在于，该方法包括以下步骤：基于理论椭圆轨道和由理论椭圆轨道旋转得到的椭圆转移轨道，预制反映固体运载火箭的位置矢量和速度矢量的夹角、速度矢量的大小随地心矢径大小变化情况的椭圆参考轨迹数表；以固体运载火箭发动机的理论剩余工作时间和固体运载火箭的初始姿态为初始值，计算预报关机时刻固体运载火箭的速度矢量Vic和位置矢量Rec；根据R_ec和椭圆参考轨迹数表，计算固体运载火箭在目标点轨道坐标系下的标准速度矢量在一个计算周期内，根据V_ic和的差值以及V_ic和R_ec，依次对剩余工作时间调整量ΔT、俯仰角调整量偏航程序角调整量Δψ进行迭代计算，直到ΔT、Δψ的绝对值均小于等于预设值，确定该计算周期内的剩余工作时间T、俯仰程序角和偏航程序角并在该计算周期内保持T、和不变；在剩余的每个计算周期内，继续对ΔT、和Δψ进行迭代计算，更新T、和直至T小于等于预设值，保持当前俯仰程序角和偏航程序角不变，直到T为0。