一种弱资源情况下的转弯控制策略设计方法与流程

本发明属于制导，具体涉及一种弱资源情况下的转弯控制策略设计方法。

背景技术：

1、垂直发射导弹在发射初始段速度较慢、动压较小、舵效较低，难以同时满足抗扰、滚转角控制和弹道转弯的控制需求。为了降低发射初始段由于舵资源紧俏等弱资源情况所导致的程序角跟踪误差较大甚至弹体发散的风险，需要在抗扰动、滚转角控制、弹道转弯三者之间做出适当取舍，更合理地利用舵资源，以保证导弹在发射初始段的飞行质量。

技术实现思路

1、为了克服现有技术的不足，本发明提供了一种弱资源情况下的转弯控制策略设计方法，依次计算滚转通道舵偏角指令、弹体实时弹道倾角和弹道偏角、发射系速度方向单位向量及速度方向指令单位向量、准弹体系速度方向单位向量及速度方向指令单位向量、准弹体系俯仰和偏航通道舵偏角指令、弹体系俯仰和偏航通道舵偏角指令，最终将弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令。本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。

2、本发明解决其技术问题所采用的技术方案如下：

3、步骤1：计算滚转通道舵偏角指令：

4、；

5、如果飞行时间小于等于n：

6、；

7、如果飞行时间大于n：

8、；

9、其中，、、均为滚转通道控制增益，为惯导测量的弹体滚转角速度，为滚转角指令，为惯导测量的弹体滚转角，为滚转通道阻尼舵偏角指令，为滚转通道阻尼+pi控制舵偏角指令，为滚转通道舵偏角指令；

10、步骤2：计算弹体实时弹道倾角和弹道偏角；

11、弹道倾角：

12、；

13、弹道偏角：

14、；

15、其中，分别为惯导测量的导弹发射系速度在x、y、z轴的分量，为弹道倾角，为弹道偏角；

16、步骤3：计算发射系速度方向单位向量及速度方向指令单位向量；

17、发射系速度方向单位向量：

18、；

19、发射系速度方向指令单位向量：

20、；

21、其中，为装定的弹道倾角指令，为装定的弹道偏角指令，分别为速度方向单位向量在发射系x、y、z轴的分量，分别为速度方向指令单位向量在发射系x、y、z轴的分量；

22、步骤4：计算准弹体系速度方向单位向量及速度方向指令单位向量；

23、准弹体系速度方向单位向量：

24、；

25、准弹体系速度方向指令单位向量：

26、；

27、其中，为惯导测量的弹体发射系俯仰角，为惯导测量的发射系偏航角，分别为速度方向单位向量在准弹体系x、y、z轴的分量，分别为速度方向指令单位向量在准弹体系x、y、z轴的分量；

28、步骤5：计算准弹体系俯仰和偏航通道舵偏角指令；

29、将俯仰和偏航角速度转为准弹体系角速度：

30、；

31、其中，分别为惯导测量的弹体偏航和俯仰角速度，为惯导测量的弹体滚转角，为准弹体偏航角速度，为准弹体俯仰角速度；

32、准弹体系俯仰和偏航通道阻尼舵偏角指令分别为：

33、；

34、其中，为俯仰偏航通道阻尼控制增益，为准弹体系俯仰通道阻尼舵偏角指令，为准弹体系偏航通道阻尼舵偏角指令；

35、准弹体系俯仰和偏航通道增稳舵偏角指令分别为：

36、；

37、其中，为俯仰偏航通道增稳控制增益，为准弹体系俯仰通道增稳舵偏角指令，为准弹体系偏航通道增稳舵偏角指令；

38、准弹体系俯仰通道弹道倾角控制舵偏角指令和偏航通道弹道偏角舵偏角指令分别为：

39、；

40、其中，分别为弹道倾角和弹道偏角指令对应空间指向与准弹体系的夹角，分别为弹道倾角和弹道偏角对应空间指向与准弹体系的夹角，为准弹体系俯仰通道弹道倾角控制舵偏角指令，为准弹体系偏航通道弹道偏角控制舵偏角指令；

41、准弹体系俯仰和偏航通道舵偏角指令分别为：

42、；

43、其中，为准弹体系俯仰通道舵偏角指令，为准弹体系偏航通道舵偏角指令；

44、步骤6：弹体系俯仰和偏航通道舵偏角指令；

45、将准弹体系俯仰和偏航通道舵偏角指令转为弹体系舵偏角指令：

46、；

47、其中，为弹体系俯仰通道舵偏角指令，为弹体系偏航通道舵偏角指令；

48、步骤7：弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令；

49、将三个通道舵偏角指令转为4片舵的舵偏角指令：

50、；

51、其中，分别为4片舵的第1、2、3、4号舵翼对应舵偏角指令。

52、优选地，所述n=12秒。

53、本发明的有益效果如下：

54、本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。

技术特征：

1.一种弱资源情况下的转弯控制策略设计方法，其特征在于，包括如下步骤：

2.根据权利要求1所述的一种弱资源情况下的转弯控制策略设计方法，其特征在于，所述n=12秒。

技术总结
本发明公开了一种弱资源情况下的转弯控制策略设计方法，依次计算滚转通道舵偏角指令、弹体实时弹道倾角和弹道偏角、发射系速度方向单位向量及速度方向指令单位向量、准弹体系速度方向单位向量及速度方向指令单位向量、准弹体系俯仰和偏航通道舵偏角指令、弹体系俯仰和偏航通道舵偏角指令，最终将弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令。本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。

技术研发人员：苗昊春,邓海鹏,皇甫逸伦,牛智奇,张宝,何轶,张伟杰,刘仲信,李琪,栗金平,高登巍,杨云刚,杜运理,李瑶
受保护的技术使用者：西安现代控制技术研究所
技术研发日：
技术公布日：2024/5/12