[发明专利]一种控制弹道顶点高度的闭路制导方法、装置及设备

权利要求书

1.一种控制弹道顶点高度的闭路制导方法，其特征在于，包括：

获取当前位置点的位置参数、目标位置点的位置参数以及所述当前位置点到所述目标位置点的飞行时间以及目标弹道顶点高度；

利用预 先设置的第一迭代函数基于当前位置点的位置参数、目标位置点的位置参数以及所述当前位置点到所述目标位置点的飞行时间进行迭代计算，得到满足最高点约束条件的当前点弹道倾角，其中，所述最高点约束条件为计算得到的弹道顶点高度与所述目标弹道顶点高度相等；

利用预先设置的第二迭代函数基于当前位置点的位置参数、目标位置点的位置参数、所述当前位置点到所述目标位置点的飞行时间以及多个所述满足最高点约束条件的当前点弹道倾角进行迭代计算，得到满足迭代截止条件的制导参数；

利用计算得到的制导参数进行制导控制。

2.根据权利要求1所述的控制弹道顶点高度的闭路制导方法，其特征在于，所述第一迭代函数为所述第二迭代函数的子函数，所述制导参数包括转移轨道焦距，所述转移轨道焦距由所述第一迭代函数计算得到，所述迭代截止条件为当次迭代计算得到的转移轨道焦距与前一次迭代计算得到的转移轨道焦距的差值小于预设值。

3.根据权利要求1所述的控制弹道顶点高度的闭路制导方法，其特征在于，所述当前位置点的位置参数包括所述当前位置点的地心距、地心纬度和地理经度，所述目标位置点的位置参数包括所述目标位置点的地心距、地心纬度和地理经度，其中，

所述利用预先设置的第一迭代函数基于当前位置点的位置参数、目标位置点的位置参数以及所述当前位置点到所述目标位置点的飞行时间进行迭代计算包括：

利用所述当前位置点的地心纬度和地理经度以及所述目标位置点的地心纬度和地理经度计算得到所述当前位置点地心矢量与所述目标位置点地心矢量的夹角；

利用所述当前位置点的地心距、所述目标位置点的地心距、所述夹角以及给定弹道倾角计算得到转移轨道焦距；

利用所述当前位置点的地心距、所述给定弹道倾角和转移轨道焦距计算得到转移轨道偏心率；

利用所述转移轨道焦距和所述转移轨道偏心率计算得到弹道顶点高度；

判断计算得到的弹道顶点高度与所述目标弹道顶点高度是否相等；

当计算得到的弹道顶点高度与所述目标弹道顶点高度相等时，将所述给定弹道倾角作为所述满足最高点约束条件的当前点弹道倾角。

4.根据权利要求3所述的控制弹道顶点高度的闭路制导方法，其特征在于，所述利用所述当前位置点的地心距、所述给定弹道倾角和转移轨道焦距计算得到转移轨道偏心率，包括：

根据所述给定弹道倾角以及所述转移轨道焦距，确定第一中间变量；

根据所述第一中间变量以及所述转移轨道焦距，确定转移轨道偏心率。

5.根据权利要求4所述的控制弹道顶点高度的闭路制导方法，其特征在于，所述利用预先设置的第二迭代函数基于当前位置点的位置参数、目标位置点的位置参数、所述当前位置点到所述目标位置点的飞行时间以及多个所述满足最高点约束条件的当前点弹道倾角进行迭代计算，包括：

根据所述第一中间变量以及所述当前位置点地心矢量与目标位置点地心矢量的夹角，确定第二中间变量；

根据所述第一中间变量、所述第二中间变量以及所述转移轨道偏心率，分别确定与所述第一中间变量和所述第二中间变量对应的第三中间变量和第四中间变量；

根据所述转移轨道焦距、所述转移轨道偏心率、所述第三中间变量以及所述第四中间变量，确定迭代飞行时间；

根据所述迭代飞行时间，确定所述迭代飞行时间对应的当次迭代计算得到的转移轨道焦距；

判断所述当次迭代计算得到的转移轨道焦距与前一次迭代计算得到的转移轨道焦距的差值是否小于预设值；

若所述当次迭代计算得到的转移轨道焦距与所述前一次迭代计算得到的转移轨道焦距的差值小于预设值，则将所述当次迭代计算得到的转移轨道焦距对应的参数作为制导参数。

6.根据权利要求1所述的控制弹道顶点高度的闭路制导方法，其特征在于，通过以下公式计算得到弹道顶点高度：

其中，为弹道顶点高度；为转移轨道焦距；为转移轨道偏心率，j为第一迭代函数的迭代次数。