一种多约束条件下三级固体火箭上升段递阶迭代制导方法及系统

本发明公开了一种多约束条件下三级固体火箭上升段递阶迭代制导方法及系统，属于航天器制导与控制领域，解决了级间指令突变问题。本发明分四级阶段：一级程序转弯攻角极值与偏航角主变量优化；二级基于一级结果修正并引入三级分段变量；三级分三段递进优化；末段三维速度增量动态补偿。采用牛顿‑拉夫逊法迭代，逐级修正误差，并通过时间扩增与线性插值实现级间姿态平滑过渡，确保执行机构稳定控制，提升制导精度与鲁棒性。本发明三级迭代制导精度高、鲁棒性强，能有效应对多种参数偏差；姿态平滑控制使指令角变化角速率下降，避免超调、弹道振荡与失控，有力促进了三级固体火箭上升段飞行的稳定性和准确性。