[发明专利]一种发射方位角计算方法及系统

说明书

本发明提供了一种发射方位角计算方法及系统。该方法包括：根据发射点的初始纬度、初始经度以及初始高度，计算发射点地固系的位置；根据目标点的纬度、经度以及高度，计算目标点地固系的位置；根据发射点的所述初始纬度和所述初始经度，计算发射点地固系到水平系的转换矩阵；根据所述发射点地固系的位置以及所述目标点地固系的位置，计算发射点到目标点的位置矢量；根据所述位置矢量以及所述转换矩阵，计算所述位置矢量在水平系下的投影；根据所述投影计算发射方位角。本发明避免了迭代方法计算发射方位角的计算量大、实时性差的问题。

技术领域

本发明涉及飞行器导航技术领域，特别是涉及一种发射方位角计算方法及系统。

背景技术

地面发射的导弹在进行发射坐标系下的惯性导航解算和弹道参数解算时，需要提供精确的发射方位角。发射方位角又称射击方位角，为过发射点的正北方向与该点瞄准方向在过该点水平面上投影的夹角，并以该点正北方向开始顺时针方向旋转为正。射击方位角的确定是导弹和运载火箭诸元准备的重要内容，如果不能准确确定发射方位角，导弹和运载火箭飞行任务将无法开展。

传统的射击方位角计算由运载火箭射击方位角计算方法演化而来，该计算受到地球扁率、地球自转的影响，而且还与弹道制导控制规律及弹道形状也息息相关。为了获取准确的射击方位角，必须通过标准弹道落点，不断迭代修正射击方位角，直至满足精度要求。

发明内容

为了避免迭代方法计算发射方位角的计算量大、实时性差的问题，本发明提供了一种发射方位角计算方法及系统，用来计算发射方位角。

为实现上述目的，本发明提供了如下方案：

一种发射方位角计算方法，包括：

根据发射点的初始纬度、初始经度以及初始高度，计算发射点地固系的位置；

根据目标点的纬度、经度以及高度，计算目标点地固系的位置；

根据发射点的所述初始纬度和所述初始经度，计算发射点地固系到水平系的转换矩阵；

根据所述发射点地固系的位置以及所述目标点地固系的位置，计算发射点到目标点的位置矢量；

根据所述位置矢量以及所述转换矩阵，计算所述位置矢量在水平系下的投影；

根据所述投影计算发射方位角。

可选地，所述发射点地固系的位置为，x₀，y₀，z₀的计算方法如下：

式中，x₀，y₀，z₀分别表示发射点在地固系下的x，y，z轴方向的位置信息，,,分别表示发射点的初始纬度、初始经度以及初始高度，，其中a表示椭球半长轴，0表示发射点， e表示椭球偏心率，表示发射点的卯酉圈主曲率半径。

可选地，所述目标点地固系的位置为，x_t，y_t，z_t的计算方法如下：