METHOD FOR CONSTRUCTING A FREE TRAJECTORY OF A BALLISTIC MISSILE AT A SPECIFIED LAUNCH ANGLE

Information

  • Patent Application
  • 20220100926
  • Publication Number
    20220100926
  • Date Filed
    July 16, 2020
    4 years ago
  • Date Published
    March 31, 2022
    2 years ago
  • CPC
    • G06F30/20
    • G06F2111/10
    • G06F2119/14
  • International Classifications
    • G06F30/20
    • G06F119/14
    • G06F111/10
Abstract
A method for constructing a free trajectory of a ballistic missile at a specified launch angle includes: setting of an initial state of iterations: based on geodetic coordinates of a launch point and a target point, a launch epoch and the specified launch angle, assuming that the earth does not rotate and a flight time is zero; generating a new flight time in a two-body force model by using known quantities and obtained auxiliary quantities; taking a difference between flight times obtained before and after the iterations as a condition for judging convergence; outputting designed parameters of the ballistic missile after the convergence is reached, or performing a differential correction including the J2 perturbation to improve the precision of the trajectory constructed, and taking a position error of the target point as a convergence condition of the differential correction.
Description
TECHNICAL FIELD

The present invention pertains to the technical field of ballistic missile trajectory construction in celestial mechanics, and more particularly, relates to a method for constructing a free trajectory of a ballistic missile at a specified launch angle.


BACKGROUND

The construction of trajectories for ballistic missiles is a prerequisite for ballistic research and data design. A complete ballistic trajectory includes a powered flight phase, a free flight phase and a reentry phase. The construction of a complete ballistic trajectory is typically accomplished based on specific performance parameters of the ballistic missile, involving some indefinite technical parameters and physical conditions that are complicated and time-consuming to compute, which cannot meet the requirements of general ballistic trajectory research and application. The free flight phase constitutes most of the flight time in the ballistic trajectory and involves a simple force analysis that mainly relates to the gravity of the earth exerted at the center of mass of the missile, in which phase the associated dynamic equations of motion of the missile are easy to solve and analyze. Hence, the development of a fast and effective method for constructing the free flight phase of a ballistic trajectory has important implications for providing a general trajectory simulation environment in the laboratory and aiding the design of ballistic data.


A trajectory constructed by taking the powered flight phase or the reentry phase or both of them as an extension of the free flight phase is referred to as a free trajectory. Article 1 (Bai Hefeng, Wu Ruilin, method for constructing trajectory of TBM [J], Modern Defense Technology, 1998(1):39-43.) proposes a method for constructing a free trajectory considering earth's rotation based on a minimum-energy trajectory theory, which is referred to as Method 1 hereinafter. Article 2 and Article 3 published later adopt the same construction method as Method 1. Specifically, Article 2 (Gu Tiejun, Liu Jian, Nie Cheng, Generation of TBM's Trajectory in the Simulation of Anti-TBM Battle [J], Modern Defense Technology, 2001(4).) corrects the reentry phase of an elliptical ballistic trajectory. Article 3 (Zhang Feng, Tian Kangsheng, Study on Construction of Trajectory for Ballistic Missile Early Warning Simulation System [J], Fire Control & Command Control, 2012, 37(3):94-98.) validates a constructed trajectory via Satellite Tool Kit (STK) software. The latter two methods also focus on the construction of free trajectories based on the minimum-energy theory.


In practice, the ballistic construction and data design must consider a combination of factors, typically focusing on not only the minimum energy as a crucial parameter, but also on other factors, such as the penetration effect of the missile on the impact velocity and the ground track of the trajectory to avoid certain deployment or sensitive areas. To comprehensively consider all factors, it is highly desirable to provide a more universal method for trajectory construction to produce alternative trajectories that are to be optimized and utilized according to specific needs in practice. Obviously, Method 1 does not meet such needs. Moreover, Method 1 has poor construction precision as it assumes that the earth is a homogeneous sphere and both the launch point and the target point are located on the surface of the sphere such that the missile is only subjected to the central gravity of the earth, and the launch point and the target point have equal geocentric radius vector moduli. Such a simplified model will cause a deviation in the impact point of the missile in terms of geometry and dynamics. This deviation increases with the range and the modulus difference between the true geocentric radius vectors of the launch point and the target point, even reaching up to tens of kilometers with regard to an intercontinental missile. In a case where the deviation of the impact point of the missile is required to be controlled on the order of hundreds of meters, consideration must be given to the oblateness of the earth while taking into account the major zonal harmonics perturbation, that is J2 perturbation, of the earth's gravitational field in the dynamic model. Method 1, however, neither considers the effect of the perturbation nor the unequal geocentric radius vector moduli of the launch point and the target point, and thus fails to meet the requirements for high-precision trajectory construction.


SUMMARY

An objective of the present invention is to provide a method for constructing a free trajectory of a ballistic missile at a specified launch angle. The method is capable of constructing a positive-flying trajectory and a negative-flying trajectory at a specified launch angle in a two-body force model and a dynamic model including the J2 perturbation of the earth's gravitational field, respectively, to derive all trajectories from a launch point to a target point by traversing the launch angle, thereby providing a wealth of alternative trajectories for general ballistic research, data design, and various application scenarios.


To achieve the objective of the present invention, the present invention adopts the following technical solutions. A method for constructing a free trajectory of a ballistic missile at a specified launch angle includes the following steps:


step 1: data preprocessing: sequentially computing a body-fixed rectangular coordinate vector {right arrow over (R)}A of a launch point A and a body-fixed rectangular coordinate vector {right arrow over (R)}B of a target point B, a difference Δφ between a geodetic latitude and a geocentric latitude of the launch point A, a horizontal angle ϕ between an AB direction and a north-pole direction of the launch point A in a body-fixed coordinate system, and a difference ε between a ratio of a modulus of the geocentric radius vector of the launch point A to a modulus of the geocentric radius vector of the target point B and 1;


step 2: setting of an initial state of iterations: assuming that the earth does not rotate and a flight time T is zero;


step 3: computing, in a two-body force model, a launch velocity vector {right arrow over ({dot over (r)})}A of a positive-flying trajectory or a negative-flying trajectory in a True Equator Mean Equinox of Epoch (TEMEE) coordinate system and a launch velocity vector {right arrow over ({dot over (R)})}A of the positive-flying trajectory or the negative-flying trajectory in the body-fixed coordinate system, a first type of non-singular orbital elements σ of the ballistic missile at a launch epoch, and a plurality of other variables to generate a new flight time T*; and


step 4: letting T=T*, repeating step 3 to iteratively compute the launch velocity vector {right arrow over ({dot over (r)})}A and the launch velocity vector {right arrow over ({dot over (R)})}A of the ballistic missile, the first type of non-singular orbital elements of the ballistic missile at the launch epoch, a half-range angle and the flight time until |T−T*| is less than a set threshold St to complete the iterations to finally obtain the launch velocity vector {right arrow over ({dot over (R)})}A and the flight time T of the ballistic missile in the two-body force model, and outputting designed parameters vp, vr, Ã, T, σ.


Compared with the prior art, the present invention has the following significant advantages. Taking the rotation of the earth into account, the present invention combines the three-dimensional (3D) geodetic coordinates of the launch point and the target point to precisely construct a free trajectory from the launch point to the target point based on a constraint on the launch angle. The advantages of the present invention include: (1) When the launch angle, the launch epoch, and the geodetic coordinates of the launch point and the target point are specified, the method is capable of constructing a free trajectory from the launch point to the target point by using a two-body force model when the rotation of the earth is considered. (2) When the launch angle, the launch epoch, and the geodetic coordinates of the launch point and the target point are specified, the method is capable of constructing a free trajectory from the launch point to the target point under the rotation of the earth by using a dynamic model that takes into account a combination of the gravity at the center of the earth and the J2 perturbation. (3) When the launch angle, the launch epoch and the geodetic coordinates of the launch point and the target point are specified, the method is capable of constructing not only a positive-flying trajectory but also a negative-flying trajectory from the target point to the launch point based on the premise of a rational launch angle. (4) Theoretically, the method is capable of constructing all free trajectories from the launch point to the target point by traversing the launch angle and specifying the positive-flying or negative-flying direction of the trajectories, thereby providing a wealth of complete alternative trajectories for various ballistic research, data design and application. (5) In the method, the launch point and the target point can be flexibly selected, where the launch point may be set as a conventional launch point or an orbit injection point, and the target point may be similarly set as a reentry point. (6) The method eliminates singularities in mathematics without special requirements on the coordinates of the launch point, such that the method is still applicable to the case where the launch point is selected to be located at the north or south pole or adjacent regions. (7) The method introduces special computation techniques. For example, the method employs the Bulirsch-Stoer (BS) rational polynomial extrapolation integration technique to compute the trajectories when the effect of the J2 perturbation of the earth is taken into account, such that the method is suitable for the computation of highly-eccentric orbits, thereby ensuring the reliability and efficiency of the computed result in extreme cases. (8) The method is capable of constructing all free trajectories from the launch point to the target point by means of traversing, including not only the classic minimum-energy trajectory (with the smallest launch velocity in inertial space) but also the practical minimum-energy trajectory (with the smallest launch velocity in the body-fixed coordinate system). (9) The method is capable of outputting various designed parameters of the missile for a comprehensive and precise characterization of the free trajectory constructed, including not only the magnitude (relative to the inertial space and the ground) and direction (the azimuth of the velocity in the horizontal plane at the launch point) of the velocity at the launch point, and the flight time of the missile, but also six orbital elements of the missile relative to the TEMEE coordinate system at the launch epoch.


The present invention will be further explained in detail below with reference to the drawings.





BRIEF DESCRIPTION OF DRAWINGS


FIG. 1 illustrates a positive-flying ballistic missile.



FIG. 2 illustrates a negative-flying ballistic missile.



FIG. 3 illustrates the launch angle h which is the intersection angle between the missile's velocity vector and the horizontal plane of the launch point A, where the horizontal plane may be replaced by the tangent plane of the reference ellipsoid in practice.



FIG. 4 illustrates a flowchart of the proposed method for constructing a free trajectory at a specified angle.



FIG. 5 illustrates the definition of the pseudo body-fixed coordinate at launch epoch t0.



FIG. 6 illustrates the definition of the TEMEE coordinate system at epoch t, in which γ and Ŷ indicate the true equinox and the mean equinox, respectively.



FIG. 7 illustrates the definition of the conventional horizontal coordinate system XYZ and the target-pointing horizontal coordinate system X*Y*Z*.



FIG. 8 illustrates a sketch of the celestial sphere and the triangle formed by points P, ZA, and ZB.



FIG. 9 illustrates spherical triangles KAA′ and KBB′ formed by the earth equator, missile trajectory and meridians.



FIG. 10A and FIG. 10B illustrate spherical triangles formed by the velocity vector, zenith and geocentric radius vector of the launch point A in the Northern hemisphere and in the Southern hemisphere, respectively.



FIG. 11 illustrates the launch velocity vector, the zenith vector and the geocentric radius vector of the launch point A.



FIG. 12 illustrates the positive-flying free trajectories (left) and the negative-flying free trajectories (right) constructed by traversing the launch angle when using the two-body force model according to Embodiment 1.



FIG. 13 a graph illustrating the function between the launch angle and the launch velocity of the positive-flying trajectories constructed by traversing based on the two-body force model.



FIG. 14 a graph illustrating the function between the launch angle and the launch velocity of the negative-flying trajectories constructed by traversing based on the two-body force model.



FIG. 15 illustrates the ground track of the minimum-energy missile trajectory constructed by the two-body force model according to Embodiment 1.



FIG. 16 illustrates the positive-flying free trajectories constructed by traversing the launch angle when using the two-body force model according to Embodiment 2.





DETAILED DESCRIPTION OF THE EMBODIMENTS

According to the present invention, referring to FIG. 4, a method for constructing a free trajectory of a ballistic missile at a specified launch angle specifically includes the following steps:


Step 1: data preprocessing: a body-fixed rectangular coordinate vector {right arrow over (R)}A of the launch point A and a body-fixed rectangular coordinate vector {right arrow over (R)}B of the target point B, a difference Δφ between the geodetic latitude and the geocentric latitude of the launch point A, a horizontal angle ϕ between the AB direction and the north-pole direction of the launch point (when the point A is not at or above the north or south pole) and a difference ε between a ratio of the modulus of the geocentric radius vector of the point A to the modulus of the geocentric radius vector of the point B and 1 are sequentially computed by specific steps as follows.


1. The geodetic coordinates of the points A and B are transformed from spherical coordinates (L, B, H) to three-dimensional (3D) rectangular coordinates (X, Y, Z) according to equation (1), and the 3D rectangular coordinates are expressed by {right arrow over (R)}A and {right arrow over (R)}B as follows:









{





X
=


(

N
+
H

)


cos

B

cos

L







Y
=


(

N
+
H

)


cos

B

sin

L







Z
=


[


N


(

1
-

e
c
2


)


+
H

]


sin

B





;





equation






(
1
)








wherein, N is the radius of curvature of the prime vertical of a point, and N=αe/√{square root over (1−ec2(sin B)2)}.


2. The geocentric latitudes φA and φB of the points A and B are computed according to equation (2):









φ
=


sin

-
1





Z



X
2

+

Y
2

+

Z
2




.






equation






(
2
)








3. The difference Δφ between the geodetic latitude and the geocentric latitude of the point A is computed according to equation (3):









Δφ
=


B
A

-


φ
A

.






equation






(
3
)








4. The horizontal angle ϕ between the AB direction and the north-pole direction of the launch point in the body-fixed coordinate system is computed according to a system of equations (4) and (5):









{






sin

ϕ

=


cos


B
B



sin


(


L
A

-

L
B


)




sin

q









cos

ϕ

=



sin


B
B


cos


B
A


-

cos


B
B


sin


B
A



cos


(


L
A

-

L
B


)





sin

q






;





equation






(
4
)








wherein, q is the zenith angle of the point B from the zenith of the point A and is computed by:









{








cos

q

=


sin


B
B


sin


B
A


+

cos


B
B


cos


B
A



cos


(


L
A

-

L
B


)











sin

q

=


1
-


cos
2


q








q



(

0
,
π

)


;





equation






(
5
)








in a particular case where the point A is located at or above the north or south pole, equations (4) and (5) are still satisfied, and are simplified as:






{






ϕ
=

π
-

(


L
A

-

L
B


)











A





is











at











or





above











the





north





pole






ϕ
=


L
A

-

L
B






A





is











at











or





above





the





south





pole













L
A




[

0
,

360

°


)





.








5. The difference ε between a ratio of the modulus of the geocentric radius vector of the point A to the modulus of the geocentric radius vector of the point B and 1 is computed according to equation (6):










ɛ
=






R


B







R


A




-
1


.




equation






(
6
)








Step 2: setting of the initial state of iterations: assuming that the earth does not rotate and the flight time T is zero.


If the earth does not rotate, the modulus vp of the launch velocity vector of the missile in the body-fixed coordinate system is equal to the modulus vr of the launch velocity vector in the TEMEE coordinate system, that is,








v
p


v
r


=

1
.





Meanwhile, the launch azimuth A* in the target-pointing horizontal coordinate system is zero.


Step 3: the launch velocity vector {right arrow over ({dot over (r)})}A of the positive-flying trajectory or the negative-flying trajectory in the TEMEE coordinate system and the launch velocity vector {right arrow over ({dot over (R)})}A of the positive-flying trajectory or the negative-flying trajectory in the body-fixed coordinate system, the first type of non-singular orbital elements a of the missile at the launch epoch, the flight time, and a plurality of other variables are computed in the two-body force model to generate a new flight time T* specifically by the following steps.


1. The coordinate vectors {right arrow over (r)}A and {right arrow over (r)}B of the points A and B in the TEMEE coordinate system are computed in combination with the flight time T according to equation (7):









{







r


A

=


M


(

t
0

)





R


A










r


B

=


M


(


t
0

+
T

)





R


B






;





equation






(
7
)








wherein, t0 is the launch epoch, and M is a time-dependent transformation matrix from the body-fixed coordinate system to the TEMEE coordinate system. In a first iteration, the flight time T is zero, and {right arrow over (r)}B=M(t0){right arrow over (R)}B is satisfied.


2. The half-range angle is computed according to equations (8) and (9) as follows:


a half intersection angle is expressed by:










δ
=


1
2

×

cos

-
1







r


A

·


r


B







r


A








r


B







;




equation






(
8
)








then the half-range angle is computed by:









β
=

{




δ




β


(

0
,

π
2


)










positive
-

flying





trajectory








π
-
δ










β






(


π
2

,
π

)










negative
-

flying





trajectory





.






equation










(
9
)







3. An inclination i and a right ascension Ω of an ascending node of an elliptical trajectory/orbit are computed according to equation (10):









{







[




sin





i





sin





Ω







-
sin






i





cos





Ω






cos





i




]

=




r


A

×


r


B







r


A

×


r


B









positive
-

flying





trajectory








[




sin





i





sin





Ω







-
sin






i





cos





Ω






cos





i




]

=




r


B

×


r


A







r


B

×


r


A









negative
-

flying





trajectory










i




(

0
,
π

)






Ω




[

0
,

2

π


)

.






equation






(
10
)








4. True arguments of latitude μA and μB of the points A and B on the elliptical trajectory/orbit are computed according to equation (11):









{






sin


u
A


=


sin






φ
A



sin





i









cos


u
A


=



sin






φ
B


-

sin






φ
A


cos

2

β



sin





i





sin





2

β









u
B

=


u
A

+

2

β






.





equation






(
11
)








5. The cosine of an angle α between the launch velocity vector and the geocentric radius vector of the launch point in the body-fixed coordinate system is computed according to equation (12):











cos





α

=


cos





Δφsin





h

-

sin





Δφcos





h






cos


(


A
*

-
ϕ

)





;




equation






(
12
)








wherein, h is the launch angle, and A*=0 in the first iteration.


6. The tangent of an angle θ between the launch velocity vector and the geocentric radius vector of the launch point in the TEMEE coordinate system is computed according to equation (13):










{





cos





θ

=



v
P


v
r



cos





α








sin

θ

=


1
-


cos
2


θ










cot

θ

=


cos

θ


sin

θ







;




equation






(
13
)








wherein,








v
P


v
r


=
1




in the first iteration.


7. A bias Δω of the argument of perigee is introduced and computed according to equation (15), and then the argument of perigee ω is computed according to equation (14).


According to the nature of the elliptical trajectory/orbit of a ballistic missile, the apogee of the trajectory is located in an outer space of the earth and between the points A and B. When the geocentric radius vector moduli of the points A and B are equal, the argument of apogee is equal to the mean value of the true arguments of latitude of the points A and B and then the mean value minus π obtains the argument of perigee ω. The argument of perigee ω computed in this way, however, generally has a deviation due to unequal geocentric distances of the point A and the point B. The bias Δω of ω is introduced to obtain:










ω
=



ω
0

+

Δω





ω




[

0
,

2

π


)



;




equation






(
14
)








wherein,








ω
0

=




u
A

+

u
B


2

-
π


,




wherein μA and μB have been computed according to equation (11); Δω is computed according to equation (15):










tan

Δ

ω

=



ɛ


2


(

1
+
ɛ

)


cot

θ

-

ɛ

cot

β








Δω



[


-





π
2


,





π
2


]






equation






(
15
)








accordingly, true anomalies of the points A and B on the elliptical trajectory/orbit are expressed by Δω as follows:










{





f
A

=

π
-
β
-

Δ

ω









f
B

=

π
+
β
-

Δ

ω







.




equation






(
16
)








8. An eccentricity e of the elliptical trajectory/orbit is computed according to equation (17):










e
=


cot

θ



sin


(

β
+

Δ

ω


)


+

cot

θ


cos


(

β
+

Δ

ω


)






.




equation






(
17
)








9. The rationality of the specified launch angle h is judged as follows. If any one of the following conditions is satisfied, then the specified launch angle is judged to be irrational such that a rationally designed trajectory cannot be obtained, the current construction procedure of the trajectory is ended, and a launch angle is re-specified.


For the positive-flying trajectory:


(1) If e≥1, then the specified launch angle is judged to be excessively large; and


(2) If cot θ≤0 or |tan Δω|≥tan β, then the specified launch angle is judged to be excessively small.


For the negative-flying trajectory:











If





e



1





or





cot





θ





-
tan


β

+


ɛ

2


(

1
+
ɛ

)





(


tan

β

+

cot





β


)




,




(
1
)







then the specified launch angle is judged to be excessively large; and










if







cot

θ



max


{



ɛ

2


(

1
+
ɛ

)




cot





β

,
0

}




,




(
2
)







then the specified launch angle is judged to be excessively small.


10. The true anomalies fA and fB of the points A and B on the elliptical trajectory/orbit are computed according to equation (16).


11. The orbital elements σ of the missile at the launch epoch are computed according to equations (18) to (21).


σ is a set of the first type of non-singular orbital elements, wherein the inclination i and the right ascension Ω of the ascending node of the orbit are computed according to equation (10), and a semi-major axis α and ξ, η, λ are computed as follows:










a
=






r


A





[

1
-

e






cos


(

β
+
Δω

)




]



1
-

e
2




;




equation






(
18
)







{





ζ
=

e





cos





ω







η
=


-
e






sin





ω







λ
=

ω
+

M
A






;





equation






(
19
)








wherein MA is computed as follows:









{






E
A

=


f
A

-

2



tan

-
1




(


e





sin






f
A



1
+


1
-

e
2



+

e





cos






f
A




)











E
B

=


f
B

-

2



tan

-
1




(


e





sin






f
B



1
+


1
-

e
2



+

e





cos






f
B




)








;





equation






(
20
)







{






M
A

=


E
A

-

e





sin






E
A










M
B

=


E
B

-

e





sin






E
B







.





equation






(
21
)








12. The flight time T* of the missile is computed according to equation (22):










{





T
*

=



M
B

-

M
A


n







n
=


μ
/

a
3








.




equation






(
22
)








13. The launch velocity vr of the missile in the TEMEE coordinate system and the launch velocity vp of the missile in the body-fixed coordinate system are computed according to equations (23) to (25) as follows:


the launch velocity vectors {right arrow over ({dot over (r)})}A and {right arrow over ({dot over (R)})}A of the missile in the TEMEE coordinate system and the body-fixed coordinate system satisfy:









{








r


.

A

=



μ
ρ




[



(



-
sin



u
A


+
η

)



P



+


(


cos


u
A


+
ξ

)



Q




]









P


=

[




cos





Ω






sin





Ω





0



]








Q


=

[





-
sin






Ω





cos





i






cos





Ω





cos





i






sin





i




]







p
=

a


(

1
-

e
2


)






;





equation






(
23
)











R


.

A

=



M


(

t
0

)






r


.

A


-



θ
.

g



[




-

Y
A







X
A





0



]




;




equation






(
24
)







then
:











{






v
p

=





R


.

A










v
r

=





r


.

A







;





equation






(
25
)








wherein, {dot over (θ)}g is a change rate of the Greenwich sidereal hour angle in the TEMEE coordinate system and is 360°.985612288/day.


14. The launch azimuth A* in the target-pointing horizontal coordinate system is computed according to equations (26) and (27):


the launch velocity vector in the target-pointing horizontal coordinate system is denoted as {right arrow over ({dot over (R)})}A*(X*,Y*,Z*), which is derived by performing a coordinate rotation on {right arrow over ({dot over (R)})}A as follows:













R


.


A
*


=

QW




R


.

A



;




equation






(
27
)









[




X
*






Y
*






Z
*




]

=






R


.


A
*






[




cos





h





cos






A
*








-
cos






h





sin






A
*







sin





h




]



;




equation






(
28
)








wherein, W is a rotation matrix from the body-fixed coordinate system to the conventional horizontal coordinate system, and Q is a rotation matrix from the conventional horizontal coordinate system to the target-pointing horizontal coordinate system.


Step 4: let T=T*, step 3 is repeated to iteratively compute the launch velocity vector of the missile, the orbital elements of the missile at the launch epoch, the half-range angle, the flight time and a plurality of other variables until |T−T*| is less than a set threshold St to complete the iterations to finally obtain the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T of the missile in the two-body force model, and designed parameters vp, vr, Ã, T, σ of the missile are output. The specific steps thereof include:


1. It is judged whether |T−T*|<St is satisfied; if yes, let T=T*, and proceeding to the next step; otherwise, let T=T*, and returning to step 3.


2. A declination à of the launch velocity vector in the target-pointing horizontal coordinate system relative to the target point in the horizontal plane is computed according to equation (28):










{





A
~

=

A
*






A
*


π







A
~

=


A
*

-

2

π







A
*

>
π





.




equation






(
28
)








3. The designed parameters vp, vr, Ã, T, σ of the missile are output.


Through steps 1 to 4, the designed parameters of the missile from the launch point to the target point are derived based on the two-body force model to support various simulation applications and trajectory construction that requires a lower precision. In a case where the trajectory construction requires higher precision and the J2 perturbation of the earth's gravitational field needs to be considered, the results obtained in the two-body force model are taken as initial values to establish a constraint equation with a constant launch angle and a differential equation based on a position error propagation of the target point for a differential correction. The specific implementation thereof includes steps 5 and 6.


Step 5: the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T obtained by the two-body force model are taken as reference solutions {right arrow over ({dot over (r)})}A0 and T0 for the differential correction; if a distance |Δ{right arrow over (R)}BB*| between the target point B and a target point B* obtained by a perturbation extrapolation based on the reference solutions is less than a given threshold SR, then the correction of the designed parameters of the missile is ended, and corrected parameters vp, vr, Ã, T, σ are output; otherwise, proceeding to step 6. In the iterative process, the thresholds are small quantities, where St may be 10 μs, and SR may be 1 cm.


Step 5 includes the following sub-steps:


1. The target point obtained by the perturbation extrapolation based on the reference solutions {right arrow over ({dot over (r)})}A0 and T0 is denoted as B*, and partial derivative matrices











r



B
*







r


A



,





r



B
*





T






and a position vector {right arrow over (r)}B* of B* in the TEMEE coordinate system are computed by a numerical integration.


To adapt to computing highly-eccentric trajectories, the numerical integration is performed by a Gragg-Bulirsch-Stoer first-order integrator (Article 4: Bulirsch R, Stoer J. Numerical Treatment of Ordinary Differential Equations by Extrapolation Methods [J]. Numerische Mathematik, 1966, 8 (1):1-13.), where the differential equations to be integrated are:









{







d


r



dt

=

v










d


v




d





t


=


F




(

r


)










d
dt



(




r








r


.

A



)


=




v








r


.

A











d
dt



(




v








r


.

A



)


=





F






r




·




r








r


.

A








;





equation






(
29
)








derive initial values as:









{







r




(

t
0

)


=


r


A









v




(

t
0

)


=



r


.

A
0












r








r


.

A





|

t
=

t
0




=
0











v








r


.

A





|

t
=

t
0




=
I




;





equation






(
30
)








integrate from t=t0 to t=t0+T0 to obtain:









{







r



B
*


=


r




|

t
=


t
0

+

T
0
















r



B
*





T


=


v




|

t
=


t
0

+

T
0
















r



B
*








r


.

A



=





r








r


.

A





|

t
=


t
0

+

T
0









;





equation






(
31
)








the force function {right arrow over (F)}({right arrow over (r)}) only including the J2 perturbation and its partial derivative matrix









F






r







in equation (29) are expressed as:









{






F


=



(


U

)

r

=


M


(
t
)


·


(


U

)

R













F






r




=



(



2


U

)

r

=


M


(
t
)


·


(



2


U

)

R

·


M
T



(
t
)








;





equation






(
32
)








wherein, t is an integration time; subscripts r and R represent a gradient or tensor of U in the TEMEE coordinate system and the body-fixed coordinate system, respectively; U represents a gravitational potential function of the earth in the body-fixed coordinate system and includes a central gravitational potential U0 and a J2 gravitational potential U1:










U
=


U
0

+

U
1



.




equation






(
33
)








Accordingly, the gradient and tensor of the gravitational potential function U of the earth are obtained as follows:









{








(


U

)

R

=



(



U
0


)

R

+


(



U
1


)

R










(



2


U

)

R

=



(



2



U
0


)

R

+


(



2



U
1


)

R






;




wherein

,





equation






(
34
)







{







(



U
0


)

R

=


-

μ

r
3






(

X
,
Y
,
Z

)

T










(



2



U
0


)

R

=


μ

r
3




[





-
1

+

3



X
2


r
2








3

XY


r
2






3

XZ


r
2








3

XY


r
2






-
1

+

3



Y
2


r
2








3

YZ


r
2








3

XZ


r
2






3

YZ


r
2





1
+

3



Z
2


r
2







]










(



U
1


)

R

=


(





U
1




X


,




U
1




Y


,




U
1




Z



)

T









(



2



U
1


)

R

=

[







2



U
1





X
2









2



U
1





X




Y









2



U
1





X




Z











2



U
1





X




X









2



U
1





Y
2









2



U
1





Y




Z











2



U
1





Z




X









2



U
1





Z




Y









2



U
1





Z
2






]





;





equation






(
35
)








wherein, (X, Y, Z)T is a 3D rectangular coordinate vector of the missile in the body-fixed coordinate system, and r=R=√{square root over (X2+Y2+Z2)}; with reference to Article 6 (Balmino G, Barriot J P, Valès N. Non-singular formulation of the gravity vector and gravity gradient tensor in spherical harmonics [J]. Manuscr Geod, 1990, 15.), the elements composing the above matrices or vectors are expressed by:









{







let






θ
1


=

X
r


;


θ
2

=

Y
r


;


θ
3

=


Z
r

=
ζ












P
_

2



(
ζ
)


=


5

×


(


3


ζ
2


-
1

)

2



;




P
_

2
!



(
ζ
)


=

3


5


ζ


;




P
_

2




(
ζ
)


=

3


5











D
r

=


-
3






C
_


2

0




(


a
e

r

)


2





P
_

2



(
ζ
)




;


D
3

=





C
_


2

0




(


a
e

r

)


2





P
¯

2




(
ζ
)












S

r

r


=

12





C
_


2

0




(


a
e

r

)


2





P
_

2



(
ζ
)




;


S

r

3


=


-
3






C
_


2

0




(


a
e

r

)


2





P
_

2




(
ζ
)




;


S

3

3


=





C
_


2

0




(


a
e

r

)


2





P
_

2




(
ζ
)











ϕ
~

=


D
r

-


D
3



θ
3














U
1




X


=


μ

r
2




ϕ
~



θ
1



;





U
1




Y


=


μ

r
2




ϕ
˜



θ
2



;





U
1




Z


=


μ

r
2




(


D
3

+


ϕ
¯



θ
3



)













2



U
1





X
2



=


μ

r
3




{


ϕ
~

+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
1
2



}












2



U
1





X




Y



=



μ

r
3




[


S
rr

+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]




θ
1



θ
2












2



U
1





X




Z



=


μ

r
3




{



(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
1


+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
1



θ
3



}












2



U
1





Y






2


=


μ

r
3




{


ϕ
~

+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
2
2



}












2



U
1





Y




Z



=


μ

r
3




{



(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
2


+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
2



θ
3



}












2



U
1





Z
2



=


μ

r
3




{


ϕ
~

+

S

3

3


+

2


(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
3


+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
3
2



}






;





equation






(
36
)








wherein, C20 is a normalized spherical harmonic coefficient corresponding to the J2 perturbation in an expansion of a spherical harmonic series of the earth's gravitational potential.


2. A position vector difference Δ{right arrow over (R)}BB* between the target point B and the target point B* obtained by the perturbation extrapolation based on the reference solutions and {right arrow over ({dot over (r)})}A0 and T0 in the body-fixed coordinate system are computed according to equations (37) and (38):











Δ







R



BB
*



=




R


B

-


R



B
*



=


[




X
B






Y
B






Z
B




]

-

[




X

B
*







Y

B
*







Z

B
*





]




;




equation






(
37
)








wherein, a coordinate vector {right arrow over (R)}B*({right arrow over (X)}B*, {right arrow over (Y)}B*, {right arrow over (Z)}B*) of B* in the body-fixed coordinate system is obtained from {right arrow over (r)}B* through a coordinate transformation:











R



B
*


=



M
T



(


t
0

+

T
0


)






r



B
*


.






equation






(
38
)








3. It is judged whether Δ{right arrow over (R)}BB* is less than the given threshold SR; if yes, the designed parameters vp, vr, Ã, T, σ of the missile are recomputed and output based on the reference solutions and corresponding equations in steps 3 and 4, and the correction is ended; otherwise, proceeding to step 6 to perform a differential correction in order to estimate a launch velocity vector increment and a flight time increment.


Step 6: the constraint equation with the constant launch angle and a differential equation based on a position error propagation of the target point are established; the launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and the flight time increment ΔT are computed, and corrected solutions are denoted as custom-character and {circumflex over (T)}; the corrected solutions are taken as reference solutions for a next differential correction, that is, let: {right arrow over ({dot over (r)})}A0=custom-character, T0={circumflex over (T)}, and repeat the sub-steps of step 5.


Step 6 includes the following sub-steps:


1. A system of linear differential equations of the launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and the flight time increment ΔT are established according to equations (39) to (41):












[



G


0




C


D



]



[




Δ




r


.

A







Δ

T




]


=

[



0





Δ



R



BB
*






]


;




equation






(
39
)








wherein, Δ{right arrow over ({dot over (r)})}A(Δ{right arrow over ({dot over (x)})}A, Δ{right arrow over ({dot over (y)})}A, Δ{right arrow over (ż)}A) and Δ{right arrow over (R)}BB*(Δ{right arrow over (x)}BB*, Δ{right arrow over (y)}BB*, Δ{right arrow over (z)}BB*) are expressed in terms of components as:












[



G


0




C


D



]



[




Δ




x


.

A







Δ




y


.

A







Δ




z


.

A







Δ

T




]


=

[



0





Δ



x



BB
*








Δ



y



BB
*








Δ



z



BB
*






]


;




equation






(
40
)








wherein, G is a 1×3 matrix, C is a 3×3 matrix, D is a 3×1 matrix, which are expressed as:









{





G
=


[


-
sin


h

cos


A
*






sin

h

sin


A
*






cos

h

]




QWM
T



(

t
0

)









C
=



M
T



(


t
0

+

T
0


)








r



B
*








r


.

A










D
=




M
T



(


t
0

+

T
0


)








r



B
*





T



+



θ
.

g





[




Y

B
*







-

X

B
*







0



]






;





equation






(
41
)








wherein,











r


B







r


.

A








and










r



B
*





T






are computed by the numerical integration in step 5. The matrix G generates the constraint equation with the constant launch angle.


2. The system of linear differential equations are solved to obtain a set of unique solutions of Δ{right arrow over ({dot over (r)})}A and ΔT;


the system of linear equations (40) includes four equations and four unknown quantities so that a set of unique solutions of Δ{right arrow over ({dot over (r)})}A and ΔT are obtained, and then the corrected solutions custom-character and {circumflex over (T)} are obtained according to equation (42):










{




=




r


.

A
0

+

Δ




r


.

A










T
^

=


T
0

+

Δ

T







.




equation






(
42
)








3. The corrected solutions are taken as the reference solutions for the next differential correction, that is, let {right arrow over ({dot over (r)})}A0=custom-character, T0={circumflex over (T)}, and repeat the sub-steps of step 5.


To facilitate the understanding of the technical solutions of the present invention, the technical solutions are described clearly and completely in conjunction with the embodiments below. The embodiments apply the variables and symbols defined in the technical solutions and derive corresponding results by assigning specific numerical values to the variables. The definitions of the coordinate systems and the transformation methods are first introduced below, and then the technical solutions are described in detail in conjunction with the embodiments.


I. Coordinate Systems and Transformation Matrices


1. Body-Fixed Coordinate System


The body-fixed coordinate system is an earth-fixed coordinate system that rotates with the earth. The body-fixed coordinate system can conveniently describe the spatial position of a point on the earth's surface, and is divided into a conventional body-fixed coordinate system and a pseudo body-fixed coordinate system according to different directions to which the Z-axis points. The difference (caused by polar motion) between the conventional body-fixed coordinate system and the pseudo body-fixed coordinate system has a minimal effect on the coordinates of the ground point. FIG. 5 illustrates the definition of the pseudo body-fixed coordinate system, in which the Z-axis points to the instantaneous pole, and the reference plane is an instantaneous equatorial plane. In the conventional body-fixed coordinate system, the Z-axis points to a conventional pole, and the reference plane is a plane orthogonal to a line connecting the center of the earth and the conventional pole. In consideration of the research background of the present invention, the difference between the conventional pole and the instantaneous pole can be ignored so that the conventional body-fixed coordinate system and the pseudo body-fixed coordinate system are collectively referred to as the body-fixed coordinate system (or geodetic coordinate system) in two forms of spherical coordinates and 3D rectangular coordinates.


2. TEMEE Coordinate System


As shown in FIG. 6, the TEMEE coordinate system is a hybrid geocentric coordinate system, in which the reference plane is an instantaneous true equatorial plane, and the X-axis is located in the reference plane and points to the mean equinox of the epoch (epoch J2000.0 herein). The mean equinox is, in fact, an imaginary point on the instantaneous true equator, and is located μ+Δμ east of the true equinox, wherein μ is the general precession of right ascension, and Δμ is the nutation of the right ascension, which are computed with reference to Article 5 (Wu Lianda. Orbits and Detection of Artificial Satellites and Space Debris, China Science and Technology Press, 2011.). With the complementary advantages of the inertial system and the instantaneous true equatorial geocentric system, the TEMEE coordinate system not only avoids causing changes in the potential function of the earth's gravitational field, but also involves minimal additional perturbation that is negligible in solving problems requiring general precision. Hence, the TEMEE coordinate system is the preferred coordinate system for the analysis method of artificial satellites.


3. Conventional Horizontal Coordinate System and Target-Pointing Horizontal Coordinate System


As shown in FIG. 7, the conventional horizontal coordinate system takes the launch point of the missile as the origin and the horizontal plane passing through the origin as the reference plane, where the X-axis points to the north pole in the reference plane. In the target-pointing horizontal coordinate system, the X*-axis points to the target point B in the reference plane. The launch azimuth A* in the present invention is defined in the target-pointing horizontal coordinate system. In consideration of the research background of the present invention, the difference between the geoid and the reference ellipsoid can be ignored so that the tangent plane of the reference ellipsoid is used instead of the horizontal plane.


4. Transformation Matrix M from the Pseudo Body-Fixed Coordinate System to the TEMEE Coordinate System


The difference between the pseudo body-fixed coordinate system and the TEMEE coordinate system (epoch J2000.0) is only the Greenwich sidereal hour angle θg in the X-axis, so that the coordinate transformation matrix M is expressed as:







M
=



R
Z



[

-

θ
g


]


=

[




cos






(

-

θ
g


)





sin






(

-

θ
g


)




0






-
sin







(

-

θ
g


)





cos






(

-

θ
g


)




0




0


0


1



]



;




wherein, θg is computed by:







θ
g

=


280


°
·
460618375


+

36



0


·
985612


2

8

8

2

d






d=MJD(UT1)−51544.5 is a Julian day number from 12h UT1 on Jan. 1, 2000 to the launch epoch t of the missile.


The transformation matrix from the TEMEE coordinate system to the pseudo body-fixed coordinate system is denoted as MT in consideration of its orthogonality.


5. Transformation Matrix W from the Body-Fixed Coordinate System to the Conventional Horizontal Coordinate System


In a case where the difference between the origins of the body-fixed coordinate system and the conventional horizontal coordinate system is not considered, a transformation between the two coordinate systems is accomplished by two rotations using a transformation matrix that is a function of the geodetic latitude and longitude of the ground point. Assuming that the geodetic latitude and longitude of the ground point are L and B, respectively, then the transformation matrix W from the body-fixed coordinate system to the conventional horizontal coordinate system is:







W
=




R
Y



[

B
-

π


/
2



]


·


R
Z



[

L
-
π

]



=

[





-

B

sin








B

cos






L





-
sin






B





sin





L




cos





B






sin





L





-
cos






L



0





cos





B





cos





L




cos





B





sin





L




sin





B




]



;




Similarly, the transformation matrix from the conventional horizontal coordinate system to the body-fixed coordinate system is denoted as WT.


5. Transformation Matrix Q from the Conventional Horizontal Coordinate System to the Target-Pointing Horizontal Coordinate System


The conventional horizontal coordinate system and the target-pointing horizontal coordinate system have the same origin and reference plane, and only differ in the direction to which the X-axis points. In the conventional horizontal coordinate system, if the azimuth of the target point B is ϕ, then the classic horizontal coordinates are rotated counterclockwise around the Z-axis by ϕ to be transformed into the target-pointing horizontal coordinates. Accordingly, the transformation matrix Q is expressed by:







Q
=



R
Z



[
ϕ
]


=

[




cos





ϕ




sin





ϕ



0






-
sin






ϕ




cos





ϕ



0




0


0


1



]



;




Similarly, the transformation matrix from the target-pointing horizontal coordinate system to the conventional horizontal coordinate system is denoted as QT.


II. Implementation of the Present Invention in Conjunction with the Embodiments


Embodiment 1: All positive-flying and negative-flying free trajectories from the launch point A to the target point B are constructed based on randomly given launch epoch to of a missile and spherical coordinates of the two points (as shown in Table 1) by traversing using a two-body force model and a dynamic model including the J2 perturbation of the earth's gravitational field, respectively.









TABLE 1







Embodiment 1


(Launch epoch: 13:45:18.732 on Aug. 24, 2012 Beijing time;


launch angle h: traversed)











Geodetic longitude
Geodetic latitude
Geodetic height


Point
L (°)
B (°)
H (m)













A
86.384
−60.756
14.00


B
116.403
60.905
49.00









Embodiment 2: All positive-flying and negative-flying free trajectories from the launch point A (at the north pole) to the target point B are constructed based on randomly given launch epoch to of a missile and spherical coordinates of the point B (as shown in Table 2) by traversing using a two-body force model and a dynamic model including the J2 perturbation of the earth's gravitational field, respectively.









TABLE 2







Embodiment 2


(Launch epoch: 13:55:25.6 on May 18, 2012 Beijing time;


launch angle h: traversed)











Geodetic longitude
Geodetic latitude
Geodetic height


Point
L (°)
B (°)
H (m)













A
∀LA ∈ [0, 360)
90.000
1000.00


B
240.500
−45.905
0.00









In addition to the above known parameters, the present invention also involves the following geophysical constants:


Equatorial radius of the reference ellipsoid: αe=6378136 m.


Geocentric gravitational constant: μ=0.39860043770442×1015 m3/s2.


Oblateness of the earth: f=1/298.25781.


Eccentricity of the meridian of the earth: ec2=2f−f2=0.0066946.


Among the above parameters, the launch epoch and the geodetic coordinates of the launch point are known, and the coordinates of the launch point in the inertial space are obtained by rotating the coordinate system. Due to the rotation of the earth, the position of the target point in the inertial space changes at all times. In this regard, the flight time is a key variable for the constructed trajectory to hit the target point with a changing position, and the flight time is computed based on the position of the target point in the inertial space. In the present invention, two variables of the flight time and inertial coordinates of the target point are iteratively computed simultaneously by specific steps as follows:


Step 1: data preprocessing: the 3D rectangular coordinate vector {right arrow over (R)}A of the launch point A and the 3D rectangular coordinate vector {right arrow over (R)}B of the target point B, the difference Δφ between the geodetic latitude and the geocentric latitude of the launch point A, the horizontal angle ϕ between the AB direction and the north-pole direction of the launch point in the body-fixed coordinate system and the difference ε between a ratio of the modulus of the geocentric radius vector of the point A to the modulus of the geocentric radius vector of the point B and 1 are sequentially computed.


Step 1 includes the following sub-steps:


1. The geodetic coordinates of the points A and B are transformed from spherical coordinates (L, B, H) to 3D rectangular coordinates (X, Y, Z) according to equation (1), and the 3D rectangular coordinates are expressed by {right arrow over (R)}A and {right arrow over (R)}B as:









{





X
=


(

N
+
H

)


cos

B

cos

L







Y
=


(

N
+
H

)


cos

B

sin

L







Z
=


[


N


(

1
-

e
c
2


)


+
H

]


sin

B





;





equation






(
1
)








wherein, N is the radius of curvature of the prime vertical of a point, and N=αe/√{square root over (1−ec2(sin B)2)}.


In Embodiment 2, the point A is located at the north pole, and thus its geodetic longitude is indefinite. In the present invention, the geodetic longitude of the point A is specified as an arbitrary value between 0° and 360°, such that the construction of trajectories is carried out smoothly without affecting the result.


2. The geocentric latitudes φA and φB of the points A and B are computed according to equation (2):









φ
=


sin

-
1





z



X
2

+

Y
2

+

Z
2




.






equation






(
2
)








3. The difference Δ100 between the geodetic latitude and the geocentric latitude of the point A is computed according to equation (3):









Δφ
=


B
A

-


φ
A

.






equation






(
3
)








4. The horizontal angle ϕ between the AB direction and the north-pole direction of the launch point in the body-fixed coordinate system is computed according to equations (4) and (5):









{






sin

ϕ

=


cos


B
B



sin


(


L
A

-

L
8


)




sin

q









cos

ϕ

=



sin


B
B


cos


B
A


-

cos


B
B


sin


B
A



cos


(


L
A

-

L
B


)





sin

q






;





equation






(
4
)








wherein, q is the zenith angle of the point B from the zenith of the point A, and is computed by:









{







cos

q

=


sin


B
B


sin


B
A


+

cos


B
B


cos


B
A



cos


(


L
A

-

L
B


)












sin

q

=


1
-


cos
2


q













q




(

0
,
π

)





.






equation






(
5
)








In a particular case where the launch point is located at or above the north or south pole, equations (4) and (5) are still satisfied, and are simplified as:






{





ϕ
=

π
-

(


L
A

-

L
B


)






A





is





at





or











above











the











north





pole






ϕ
=


L
A

-

L
B






A





is





at











or





above











the











south











pole









L
A




[

0
,

360

°


)

.








Equations (4) and (5) are derived from the formulas of spherical trigonometry applied to the spherical triangle O-PZAZB in FIG. 8. O is the center of the earth. P, ZA, ZB and γ are the projections of the north pole, the zenith of the launch point, the zenith of the target point and the equinox on the celestial sphere, respectively. The great circle defined by custom-character is an extension of the equator on the celestial sphere, where E is the intersection point of the great circle passing P and ZB and the equatorial plane, and F is the intersection point of the great circle passing P and ZA and the equatorial plane. The great circle defined by custom-character is perpendicular to OZA; and the great circle defined by custom-character is perpendicular to OZB. The difference between the geoid and the reference ellipsoid is ignored, such that angular distance ∠POZB represents the complementary angle of the geodetic latitude of the point B and is equal to







(


π
2

-

B
B


)

.




Angular distance ∠POZA represents the complementary angle of the geodetic latitude of the point A and is equal to







(


π
2

-

B
A


)

.




Spherical angle ZBPZA represents an angle between meridians passing through the points A and B, and is equal to (LA−LB). Spherical angle ∠ZAPZB is the zenith angle of the point B from the zenith of the point A and is denoted as q. ∠ZBZAP is denoted as ϕ to be computed. According to the law of sines of spherical trigonometry and the five-element formulas, the following two equations are derived:






{







sin

ϕ


sin


(


π
2

-

B
B


)



=


sin


(


L
A

-

L
B


)



sin

q









sin

q

cos

ϕ

=



cos


(


π
2

-

B
B


)




sin


(


π
2

-

B
A


)



-








sin


(


π
2

-

B
B


)




cos


(


π
2

-

B
A


)




cos


(


L
A

-

L
B


)






,





simplified as the following equations for computing ϕ:






{






sin

ϕ

=


cos


B
B



sin


(


L
A

-

L
B


)




sin

q









cos

ϕ

=



sin


B
8


cos






B
A


-

cos


B
B


sin


B
A



cos


(


L
A

-

L
B


)





sin

q






.





According to the law of cosines of spherical trigonometry, q is expressed by:








cos

q

=



cos


(


π
2

-

B
B


)




cos


(


π
2

-

B
A


)



+


sin


(


π
2

-

B
B


)




sin


(


π
2

-

B
A


)




cos


(


L
A

-

L
B


)





,




rewritten as:






{








cos

q

=




sin

B

B




sin

B

A


+



cos

B

B




cos

B

A



cos


(


L
A

-

L
B


)











sin

q

=


1
-


cos
2


q












q



(

0
,
π

)


;





wherein the value of q is limited within (0,π). The two points A and B must not coincide or be located at the two ends of the diameter of the earth for the following reason. If the target point and the launch point coincide, then it does not meet the actual need for constructing a trajectory. If the target point and the launch point are located at the two ends of the diameter of the earth, then there exist countless elliptical trajectories passing through the two points at the specified launch angle, such that it is impossible to derive a unique set of designed parameters of the missile.


5. The difference ε between a ratio of the modulus of the geocentric radius vector of the point A to the modulus of the geocentric radius vector of the point B and 1 is computed according to equation (6):









ɛ
=






R


B







R


A




-
1.





equation






(
6
)








The moduli of the geocentric radius vectors of the points A and B are typically not equal, and the geodetic height difference between the points A and B is much smaller than the radius of the earth. Thus, ε is typically a small non-zero quantity.


Step 2: setting of the initial state of iterations: assuming that the earth does not rotate and the flight time T is zero.


If the earth does not rotate, the launch velocity vp of the missile in the body-fixed coordinate system is equal to the launch velocity vr in the TEMEE coordinate system, that is,








v
p


v
r


=
1.




Meanwhile, the launch azimuth A* in the target-pointing horizontal coordinate system is zero.


Step 3: the launch velocity vector {right arrow over ({dot over (r)})}A of the positive-flying trajectory or the negative-flying trajectory in the TEMEE coordinate system and the launch velocity vector {right arrow over ({dot over (R)})}A of the positive-flying trajectory or the negative-flying trajectory in the body-fixed coordinate system, the orbital elements σ of the missile at the launch epoch, the flight time and a plurality of other variables are computed in the two-body force model to obtain a new flight time T*.


Step 3 includes the following sub-steps:


1. The coordinate vectors {right arrow over (r)}A and {right arrow over (r)}B of the points A and B in the TEMEE coordinate system are computed in combination with the flight time T according to equation (7):









{







r


A

=


M


(

t
0

)





R


A










r


B

=


M


(


t
0

+
T

)





R


B






;





equation






(
7
)








wherein, t0 is the launch epoch, and M is a time-dependent transformation matrix transformation matrix from the body-fixed coordinate system to the TEMEE coordinate system. In the first iteration, the flight time T is zero, and {right arrow over (r)}B=M(t0){right arrow over (R)}B is satisfied.


2. The half-range angle β is computed according to equations (8) and (9):


a half intersection angle is expressed by:










δ
=


1
2

×

cos

-
1







r


A

·


r


B







r


A








r


B







;




equation






(
8
)








then the half-range angle is computed by:









β
=

{




δ



β


(

0
,

π
2


)





positive
-

flying





trajectory







π
-
δ




β


(


π
2

,
π

)





negative
-

flying





trajectory





;






equation






(
9
)








3. The inclination i and the right ascension Ω of the ascending node of the elliptical trajectory/orbit are computed according to equation (10):









{







[




sin

i

sinΩ






-

sin

i

cosΩ







cos

i




]

=




r


A

·


r


B







r


A

×


r


B









positive
-

flying





trajectory








[




sin

i

sinΩ






-

sin

i

cosΩ







cos

i




]

=




r


B

·


r


A







r


B

×


r


A









negative
-

flying





trajectory










i




(

0
,
π

)






Ω




[

0
,

2

π


)

.






equation






(
10
)








4. The true arguments of latitude μA and μB of the points A and B on the elliptical trajectory/orbit are computed according to equation (11):









{






sin

u

A

=


sinφ
A


sin

i











cos

u

A

=



sinφ
B

-


sinφ
A


cos2β



sin

i

sin2β



;







u
B

=


u
A

+

2

β










equation






(
11
)








Equation (11) is derived from the law of sines applied to the spherical triangles in FIG. 9. In the spherical triangle O-KAA′, spherical angle ∠AKA′ is equal to the orbital inclination i of the trajectory; angular distance ∠AOA′ is equal to the geocentric latitude φA of the point A; angular distance ∠AOK is equal to the true argument of latitude μA of the point A; and sin μA is expressed according to the law of sines as follows:








sin

u

A

=



sinφ
A


sin

i


.





Similarly, in the spherical triangle O-KBB′,








sin

u

B

=



sinφ
B


sin

i


.





The half-range angle β is known and μBA+2β is satisfied, which is substituted into the above equations to obtain:








sin

u

B

=


sin


(


u
A

+

2

β


)


=




sin

u

A


cos2β

+



cos

u

A



sin2β
.








The expressions of sin μA and sin μB are substituted to obtain:









sinφ
B


sin

i


=




sinφ
A


sin

i



cos2β

+



cos

u

A


sin2β



,




simplified as:








cos

u

A

=




sinφ
B

-


sinφ
A


cos2β



sin

i

sin2β


.





5. The cosine of the angle α between the launch velocity vector and the geocentric radius vector of the launch point in the body-fixed coordinate system is computed according to equation (12):










cosα
=


cosΔφsin

h

-


sinΔφcos

h

cos



(


A
*

-
ϕ

)




;




equation






(
12
)








wherein, h is the launch angle, and A*=0 in the first iteration.


Equation (12) is derived from the law of cosines applied to the spherical triangles in FIG. 10A and FIG. 10B. The spherical triangle in FIG. 10A and FIG. 10B is formed by the projections of the velocity vector, radius vector and zenith of the point A on the celestial sphere, where the spatial directions of the velocity, the zenith and the radius vector of the point A are shown in FIG. 11. In the spherical triangle A-ZRV, angular distance ∠ZAR represents the difference Δ100 between the geodetic latitude and the geocentric latitude of the point A. According to the definition of the launch angle h, angular distance ∠ZAV is the complementary angle of h, namely







α
~

=


π
2

-

h
.






∠PZV is the azimuth of the launch velocity vector and denoted as Θ, which is equal to (A*−ϕ). Angular distance ∠VAR is the angle α between the launch velocity vector and the geocentric radius vector of the launch point in the body-fixed coordinate system and is to be computed. According to the law of cosines, the angle is expressed by:








cos

α

=


cos





Δφcos


α
~


+

sin





Δφsin


α
~



cos


(

π
-
θ

)





;




{tilde over (α)} and Θ are substituted into the above equation to obtain:







cos

α

=


cos





Δφsinh

-

sin





Δφcos





h







cos


(


A
*

-
ϕ

)


.







6. The tangent of the angle θ between the launch velocity vector and the geocentric radius vector of the launch point in the TEMEE coordinate system is computed according to equation (13):









{





cos

θ

=



v
P


v
r



cos

α








sin

θ

=


1
-


cos
2


θ










cot

θ

=


cos

θ


sin

θ










equation






(
13
)








Due to the rotation of the earth, the launch velocity vector in the TEMEE coordinate system is a resultant of the launch velocity vector in the body-fixed coordinate system and the rotational velocity vector of the earth. Since the rotational velocity vector of the earth is perpendicular to the geocentric radius vector, the launch velocity vectors in the two coordinate systems have equal components in the direction of the geocentric radius vector. Accordingly:











r


.

A

·



r


A





r


A





=




R


.

A

·



R


A





R


A






,




simplified as:












r


.

A




cos





θ

=






R


.

A




cos






α
.






Because |{right arrow over ({dot over (r)})}A|=vr; |{right arrow over ({dot over (R)})}A|=vp, the above equation can be rewritten as:









v
r


cos

θ

=


v
P


cos

α


;




wherein, in the first iteration,








v
P


v
r


=

1
.





7. A bias Δω of the argument of perigee is introduced and computed according to equation (15), and then the argument of perigee ω is computed according to equation (14).


According to the nature of the elliptical trajectory/orbit, the apogee of the trajectory is located in an outer space of the earth and between the points A and B. When the geocentric radius vector moduli of the points A and B are equal, the argument of apogee is equal to the mean value of the true arguments of latitude of the points A and B, and the mean value minus π obtains the argument of perigee ω. The argument of perigee ω computed in this way, however, generally has a deviation due to unequal geocentric distances of the point A and the point B. The bias Δω of ω is introduced to obtain:










ω
=



ω
0

+

Δω





ω




[

0
,

2

π


)



;




equation






(
14
)








wherein,








ω
0

=




u
A

+

u
B


2

-
π


,




wherein μA and μB have been computed according to equation (11); Δω is computed according to equation (15):











tan

Δ

ω

=



ɛ


2


(

1
+
ɛ

)


cot

θ

-

ɛ

cot

β








Δω



[


-





π
2


,

π
2


]



;




equation






(
15
)








accordingly, the true anomalies of the points A and B on the elliptical trajectory/orbit are expressed by Δω as follows:










{





f
A

=

π
-
β
-

Δ

ω









f
B

=

π
+
β
-

Δ

ω







.




equation






(
16
)








Equation (15) is derived as follows. A polar coordinate system is established on an orbital plane, then a polar coordinate equation of an elliptic curve is expressed as:







r
=

p

1
+

e

cos

f




;




wherein, p is a semi-laths rectum. The polar radii of the points A and B are:






{






r
A

=

p

1
+

e





cos






f
A











r
B

=

p

1
+

e





cos






f
B








;





rA=|{right arrow over (R)}A| and rB=|{right arrow over (R)}B| are substituted into equation (6) to obtain:







ɛ
=



1
+

e





cos


f
A




1
+

e





cos


f
B




-
1


,




rewritten as:







1
+

e





cos






f
A



=


(

1
+
ɛ

)




(

1
+

e





cos






f
B



)

.






The expressions of fA and fB in equation (16) are substituted to obtain:







sin





Δω

=



ɛ


(

1
-

e






cos


(

β
-

Δ

ω


)




)



2

e





sin





β


.





Equation (17) for computing e is substituted into the expression of sin Δω to obtain the most compact form expressed as equation (15).


8. The eccentricity e of the elliptical trajectory/orbit is computed according to equation (17).










e
=


cot





θ



sin


(

β
+

Δ

ω


)


+

cot





θ






cos


(

β
+

Δ

ω


)






;




equation






(
17
)








wherein, θ is the angle between the launch velocity vector of the missile and the geocentric radius vector in the TEMEE coordinate system, and is determined jointly by the eccentricity of the elliptical orbit and the true anomaly of the launch point. The relationship between the three is expressed as:








tan





θ

=


1
+

e





cos






f
A




e





sin






f
A




,




rewritten as:







e
=


cot





θ



sin






f
A


-

cot





θ





cos






f
A





,




fA=π−β−Δω is substituted into the above equation to obtain:






e
=



cot





θ



sin


(

β
+

Δ

ω


)


+

cot





θ






cos


(

β
+

Δ

ω


)





.





9. The rationality of the specified launch angle h is judged as follows. If any one of the following conditions is satisfied, then the specified launch angle is judged to be irrational such that a rationally designed trajectory cannot be obtained, the current construction procedure of the trajectory is ended, and a launch angle is re-specified.


For the positive-flying trajectory:


(1) If e≥1, then the specified launch angle is judged to be excessively large; and


(2) If cot θ≤0 or |tan Δω|≥tan β, then the specified launch angle is judged to be excessively small.


For the negative-flying trajectory:











If





e



1





or





cot





θ





-
tan






β

+


ɛ

2


(

1
+
ɛ

)





(


tan





β

+

cot





β


)




,




(
1
)







then the specified launch angle is judged to be excessively large; and











If





cot





θ



max


{



ɛ

2


(

1
+
ɛ

)




cot





β

,
0

}



,




(
2
)







then the specified launch angle is judged to be excessively small.


10. The true anomalies fA and fB of the points A and B on the elliptical trajectory/orbit are computed according to equation (16).


11. The orbital elements a of the missile at the launch epoch are computed according to equations (18) to (21).


σ is a set of the first type of non-singular orbital elements, wherein the inclination i and the right ascension Ω of the ascending node of the orbit are computed according to equation (10), and a semi-major axis α and ξ, η, λ are computed as follows:










a
=


|


r


A

|

[

1
-

e






cos


(

β
+

Δ

ω


)




]



1
-

e
2




;




equation






(
18
)







{





ξ
=

e





cos





ω







η
=


-
e






sin





ω







λ
=

ω
+

M
A






;





equation






(
19
)








wherein MA is computed as follows:









{






E
A

=


f
A

-

2







tan

-
1


(


e





sin






f
A



1
+


1
-

e
2



+

e





cos






f
A




)










E
B

=


f
B

-

2







tan

-
1


(


e





sin






f
B



1
+


1
-

e
2



+

e





cos






f
B




)







;





equation






(
20
)







{






M
A

=


E
A

-

e





sin






E
A










M
B

=


E
B

-

e





sin






E
B







.





equation






(
21
)








12. The flight time T* of the missile is computed according to equation (22):









{






T
*

=



M
B

-

M
A


n







n
=


μ
/

a
3







.





equation






(
22
)








13. The launch velocity vr of the missile in the TEMEE coordinate system and the launch velocity vp of the missile in the body-fixed coordinate system are computed according to equations (23) to (25), where the launch velocity vectors {right arrow over ({dot over (r)})}A and {right arrow over ({dot over (R)})}A of the missile in the TEMEE coordinate system and the body-fixed coordinate system satisfy:









{







r


.


A

=



μ
p




[



(



-
sin







u
A


+
η

)



P



+


(


cos






u
A


+
ξ

)



Q




]









P


=

[




cos





Ω






sin





Ω





0



]








Q


=

[





-
sin






Ω





cos





i






cos





Ω





cos





i






sin





i




]







p
=

a


(

1
-

e
2


)






;





equation






(
23
)











R


.


A

=



M


(

t
0

)





r


.


A


-



θ
.

g



[




-

Y
A







X
A





0



]




;







then


:






equation






(
24
)







{






v
p

=




R


.


A










v
r

=




r


.


A







;





equation






(
25
)








wherein, {dot over (θ)}g is a change rate of the Greenwich sidereal hour angle in the TEMEE coordinate system and is 360°.985612288/day.


14. The launch azimuth A* in the target-pointing horizontal coordinate system is computed according to equations (26) and (27):


the launch velocity vector in the target-pointing horizontal coordinate system is denoted as {right arrow over ({dot over (R)})}A*(X*, Y*, Z*), and which is derived by performing a coordinate rotation on {right arrow over ({dot over (R)})}A as follows:













R


.



A
*


=

QW



R


.


A



;









equation






(
26
)









[




X
*






Y
*






Z
*




]

=





R


.



A
*






[




cos





h





cos






A
*








-
cos






h





sin






A
*







sin





h




]



;




equation






(
27
)








wherein, W is a rotation matrix from the body-fixed coordinate system to the conventional horizontal coordinate system, and Q is a rotation matrix from the conventional horizontal coordinate system to the target-pointing horizontal coordinate system.


Step 4: let T=T*, step 3 is repeated to iteratively compute the launch velocity vector of the missile, the orbital elements of the missile at the launch epoch, the half-range angle, the flight time and a plurality of other variables until |T−T*| is less than the set threshold St to complete the iterations to finally obtain the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T of the missile in the two-body force model.


Step 4 includes the following sub-steps:


1. It is judged whether |T−T*|<St is satisfied; if yes, let T=T*, and proceeding to the next step; otherwise, let T=T*, and returning to step 3.


2. The declination à of the launch velocity vector in the target-pointing horizontal coordinate system relative to the target point in the horizontal plane is computed according to equation (28):









{






A
~

=

A
*






A
*


π







A
~

=


A
*

-

2

π







A
*

>
π




.





equation






(
28
)








3. The designed parameters vp, vr, Ã, T, σ of the missile obtained based on the two-body force model are output.


Step 5: the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T obtained by the two-body force model are taken as reference solutions {right arrow over ({dot over (r)})}A0 and T0 for the differential correction; if the distance |Δ{right arrow over (R)}BB*| between the target point B and the target point B* obtained by a perturbation extrapolation based on the reference solutions is less than the given threshold SR, then the correction of the designed parameters of the missile is ended, and corrected parameters vp, vr, Ã, T, σ are output; otherwise, proceeding to step 6.


Step 5 includes the following sub-steps:


1. The target point obtained by the perturbation extrapolation based on the reference solutions {right arrow over ({dot over (r)})}A0 and T0 is denoted as B*, and partial derivative matrices











r



B
*







r


A



,





r



B
*





T






and a position vector {right arrow over (r)}B* of B* in the TEMEE coordinate system are computed by a numerical integration.


To adapt to computing highly-eccentric trajectories, the numerical integration is performed by a Gragg-Bulirsch-Stoer first-order integrator, where the differential equations to be integrated are:









{







d


r



dt

=

v










d


v




d

t


=


F




(

r


)










d

d

t




(




r
˜







r


.

A



)


=




v








r


.

A











d

d

t




(




v








r


.

A



)


=





F






r




·




r








r


.

A








;





equation






(
29
)








derive initial values as:









{







r




(

t
0

)


=


r


A









v




(

t
0

)


=



r


.

A
0













r








r


.

A






t
=

t
0



=
0












ν








r


.

A






t
=

t
0



=
I




;





equation






(
30
)








integrate from t=t0 to t=t0+T0 to obtain:









{









r



B
*


=

r






t
=


t
0

+

T
0
















r



B
*





T


=

v






t
=


t
0

+

T
0
















r



B
*








r


.

A



=




r








r


.

A







t
=


t
0

+

T
0







;





equation






(
31
)








the force function {right arrow over (F)}({right arrow over (r)}) only including the J2 perturbation and its partial derivative matrix









F






r







in equation (29) are expressed as:









{






F


=



(


U

)

r

=


M


(
t
)


·


(


U

)

R













F






r




=



(



2


U

)

r

=


M


(
t
)


·


(



2


U

)

R

·


M
T



(
t
)








;





equation






(
32
)








wherein, t is an integration time; subscripts r and R represent a gradient or tensor of U in the TEMEE coordinate system and the body-fixed coordinate system, respectively; U represents a gravitational potential function of the earth in the body-fixed coordinate system and includes a central gravitational potential U0 and a J2 gravitational potential U1:










U
=


U
0

+

U
1



.




equation






(
33
)








Accordingly, the gradient and tensor of the gravitational potential function U of the earth are obtained as follows:









{








(


U

)

R

=



(



U
0


)

R

+


(



U
1


)

R










(



2


U

)

R

=



(



2



U
0


)

R

+


(



2



U
1


)

R






;




wherein

,





equation






(
34
)







{







(



U
0


)

R

=


-

μ

r
3






(

X
,
Y
,
Z

)

T










(



2



U
0


)

R

=


μ

r
3




[





-
1

+

3



X
2


r
2








3

XY


r
2






3

XZ


r
2








3

XY


r
2






-
1

+

3



Y
2


r
2








3

Y

Z


r
2








3

XZ


r
2






3

Y

Z


r
2





1
+

3



Z
2


r
2







]










(



U
1


)

R

=


(





U
1




X


,




U
1




Y


,




U
1




Z



)

T










(



2



U
1


)

R

=

[







2



U
1





X
2









2



U
1





X




Y









2



U
1





X




Z











2



U
1





Y




X









2



U
1





Y
2









2



U
1





Y




Z











2



U
1





Z




X









2



U
1





Z




Y









2



U
1





Z
2






]










;





equation






(
35
)








wherein, (X, Y, Z)T is a 3D rectangular coordinate vector of the missile in the body-fixed coordinate system, and r=R=√{square root over (X2+Y2+Z2)}. With reference to Article 6 (Balmino G, Barriot J P, Valès N. Non-singular formulation of the gravity vector and gravity gradient tensor in spherical harmonics [J]. Manuscr Geod, 1990, 15.), the elements composing the above matrices or vectors are expressed by:









{







let






θ
1


=

X
r


;


θ
2

=

Y
r


;


θ
3

=


Z
r

=
ζ












P
_

2



(
ζ
)


=


5

×


(


3


ζ
2


-
1

)

2



;




P
_

2




(
ζ
)


=

3


5


ζ


;




P
_

2
′′



(
ζ
)


=

3


5











D
r

=


-
3






C
_


2

0




(


a
e

r

)


2





P
_

2



(
ζ
)








;


D
3

=





C
_


2

0




(


a
e

r

)


2





P
_

2




(
ζ
)












S

r

r


=

12





C
_


2

0




(


a
e

r

)


2





P
_

2



(
ζ
)








;


S

r

3


=


-
3






C
_


2

0




(


a
e

r

)


2





P
_

2




(
ζ
)




;


S

3

3


=





C
_


2

0




(


a
e

r

)


2





P
_

2
′′



(
ζ
)











ϕ
~

=


D
r

-


D
3



θ
3














U
1




X


=


μ

r
2




ϕ
~



θ
1



;





U
1




Y


=


μ

r
2




ϕ
~



θ
2



;





U
1




Z


=


μ

r
2




(


D
3

+


ϕ
˜



θ
3



)













2



U
1





X
2



=


μ

r
3




{


ϕ
~

+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
1
2



}












2



U
1





X




Y



=



μ

r
3




[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]




θ
1



θ
2












2



U
1





X




Z



=


μ

r
3




{



(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
1


+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
1



θ
3



}












2



U
1





Y
2



=


μ

r
3




{


ϕ
~

+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
2
2



}












2



U
1





Y




Z



=


μ

r
3




{



(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
2


+


[


S

r

r


+

2


(


D
3

-

S

r

3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
2



θ
3



}












2



U
1





Z
2



=


μ

r
3




{


ϕ
~

+

S

3

3


+

2


(


S

r

3


-

D
3

-


S

3

3




θ
3



)



θ
3


+


[


S

r

r


+

2


(


D
3

-

S

r





3



)



θ
3


-

ϕ
~

+


S

3

3




θ
3
2



]



θ
3
2



}






;





equation






(
36
)








wherein, C20 is a normalized spherical harmonic coefficient corresponding to the J2 perturbation in an expansion of a spherical harmonic series of the earth's gravitational potential.


2. The position vector difference Δ{right arrow over (R)}BB* between the target point B and the target point B* obtained by the perturbation extrapolation based on the reference solutions {right arrow over ({dot over (r)})}A0 and T0 in the body-fixed coordinate system is computed according to equations (37) and (38):











Δ



R



BB
*



=




R


B

-


R



B
*



=


[




X
B






Y
B






Z
B




]

-

[




X

B
*







Y

B
*







Z

B
*





]




;




equation






(
37
)








wherein, the coordinate vector {right arrow over (R)}B*({right arrow over (X)}B*, {right arrow over (Y)}B*, {right arrow over (Z)}B*) of B* in the body-fixed coordinate system is obtained from {right arrow over (r)}B* through a coordinate transformation:












R



B
*


=



M
T



(


t
0

+

T
0


)





r



B
*




.




equation






(
38
)








3. It is judged whether Δ{right arrow over (R)}BB* is less than the given threshold SR; if yes, the designed parameters vp, vr, Ã, T, σ of the missile are recomputed and output based on the reference solutions and corresponding equations in steps 3 and 4, and the correction is ended; otherwise, proceeding to step 6 to perform a differential correction in order to estimate a launch velocity vector increment and a flight time increment.


Step 6: the constraint equation with the constant launch angle and a differential equation based on a position error propagation of the target point are established; the launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and the flight time increment ΔT are computed, and corrected solutions are denoted as custom-character and {circumflex over (T)}; the corrected solutions are taken as reference solutions for a next differential correction, that is, let: {right arrow over ({dot over (r)})}A0=custom-character, T0={circumflex over (T)}, and repeat the sub-steps of step 5.


Step 6 includes the following sub-steps:


1. A system of linear differential equations of the launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and the flight time increment ΔT are established according to equations (39) to (41):












[



G


0




C


D



]



[




Δ




r


.

A







Δ

T




]


=

[



0





Δ



R



B

B


*




]


;




equation






(
39
)








wherein, Δ{right arrow over ({dot over (r)})}A(Δ{right arrow over ({dot over (x)})}A, Δ{right arrow over ({dot over (y)})}A, Δ{right arrow over (ż)}A) and Δ{right arrow over (R)}BB*(Δ{right arrow over (x)}BB*, Δ{right arrow over (y)}BB*, Δ{right arrow over (z)}BB*) are expressed in terms of components as:












[



G


0




C


D



]



[




Δ




x


.

A







Δ




y


.

A







Δ




z


.

A







Δ

T




]


=

[



0





Δ



x



BB
*








Δ



y



BB
*








Δ



z



BB
*






]


;




equation






(
40
)








wherein, G is a 1×3 matrix, C is a 3×3 matrix, D is a 3×1 matrix, which are expressed as:









{





G
=






[


-




sin






h





cos






A
*






sin

h

sin


A
*






cos

h

]


Q

W



M
T



(

t
0

)









C
=



M
T



(


t
0

+

T
0


)








r



B
*








r


.


A
*











D
=




M
T



(


t
0

+

T
0


)








r



B
*





T



+



θ
.

g



[




Y

B
*







-

X

B
*







0



]







;





equation






(
41
)








wherein,











r



B
*








r


.

A














and










r



B
*





T






are computed by the numerical integration in step 5. The matrix G generates the constraint equation with the constant launch angle.


2. The system of linear differential equations are solved to obtain a set of unique solutions of Δ{right arrow over ({dot over (r)})}A and ΔT;


the system of linear equations (40) includes four equations and four unknown quantities so that a set of unique solutions of Δ{right arrow over ({dot over (r)})}A and ΔT are obtained, and then the corrected solutions custom-character and {circumflex over (T)} are obtained according to equation (42):










{




=




r


.

A
0

+

Δ




r


.

A










T
^

=


T
0

+

Δ

T







.




equation






(
42
)








3. The corrected solutions are taken as the reference solutions for the next differential correction, that is, let {right arrow over ({dot over (r)})}A0=custom-character, T0={circumflex over (T)}, and repeat the sub-steps of step 5.


III. Results of Constructing the Trajectory


According to the method for constructing the free trajectory, when the geodetic coordinates of the launch point and the target point and the launch angle are given, the launch velocity vector and flight time of the trajectory can be derived by the two-body force model and the dynamic model including the J2 perturbation, respectively. Conversely, when the coordinates of the launch point and the launch velocity vector are known, an integration is performed over the length of the flight time by the corresponding force model. The integral of the geocentric radius vector should coincide with the coordinates of the target point, and the integral coordinates in the integration range forms the trajectory of the missile.


According to the known data of Embodiment 1, the launch angle is traversed from 1° by an increment of 1° to construct 46 positive-flying trajectories (at launch angle in the range of 1-46°) and 23 negative-flying trajectories (at launch angle in the range of 1-23°). If the launch angle falls outside the above ranges, then it is impossible to obtain a rationally designed trajectory. FIG. 12 illustrates all positive-flying free trajectories (left) and negative-flying free trajectories (right) constructed by the two-body force model. Different gray values represent different launch angles. The impact points of the trajectories are all converged at the target point B, so are the impact points of highly-eccentric orbits (the eccentricity of an elliptical orbit at a launch angle of 46° is 0.77), which verifies the correctness of the method for constructing the trajectory of the present invention. Each successfully constructed trajectory corresponds to a set of output parameters, including vp, vr, Ã, T, σ. For example, when the specified launch angle is 10°, the output parameters of the positive-flying and negative-flying trajectories constructed according to Embodiment 1 are shown in Table 3. The comparison of the data in Table 3 indicates that when the launch angle is constant, the launch velocity of the negative-flying trajectory is much higher than that of the positive-flying trajectory, which is matched with the fact that a longer-range trajectory requires more launch energy. Therefore, the minimum-energy trajectory from the launch point to the target point must be a shorter-range positive-flying trajectory. By traversing the launch angle, the method for constructing the trajectory of the present invention is capable of determining not only a classic minimum-energy trajectory (with the smallest launch velocity in the inertial space) but also a practical minimum-energy trajectory (with the smallest launch velocity in the body-fixed coordinate system) among numerous successfully constructed positive-flying trajectories. FIGS. 13 and 14 respectively illustrate the functions between the launch angle and the launch velocity of the positive-flying and negative-flying trajectories constructed by means of traversing according to Embodiment 1, in which the positive-flying trajectory with the smallest launch velocity corresponding to a launch angle of 14° can be identified visibly, while the launch velocity of the negative-flying trajectory is a monotonically increasing function of the launch angle without a minimum value. When the primary concern for trajectory selection is not the minimum energy but the velocity at the impact point or the ground track, the ground track needs to be superimposed on the map data for optimization, as shown in FIG. 15, wherein the velocity at the impact point is directly proportional to the launch angle. In either case, the method for constructing the trajectory of the present invention can provide a wealth of alternative trajectories.


When the construction of the trajectories requires a precision of the order of kilometers or higher, the method for constructing the trajectory based on the two-body force model cannot meet such requirements. To this end, additional considerations must be given to the effects of perturbations such as the earth's non-central gravity, atmospheric drag and solar pressure. Having taken into account the J2 perturbation of the earth's gravitational field, the method for precisely constructing the trajectories of the present invention only needs to append the perturbations such as the atmospheric drag and solar pressure into its framework when necessary. The ballistic parameters derived by the two-body force model, as shown in Table 3, are taken as reference solutions to perform a differential correction for the position error propagation of the target point. The J2 perturbation is considered in the position propagation of the target point. The results of the differential correction are shown in Table 4, in which the symbol “↑” or “↓” represents an increase or decrease in the ballistic parameter after being corrected.


According to the known data, Embodiment 2 successfully constructs 54 positive-flying trajectories and 32 negative-flying trajectories by using the same traversal method as in Embodiment 1. FIG. 16 illustrates the 54 positive-flying trajectories. Since the launch point is located at the north pole, its longitude is indefinite and constitutes a singularity in Method 1. In this case, the method for constructing the trajectories of the present invention can still successfully construct and characterize the trajectories in the 3D rectangular coordinate system, as shown in FIG. 16, in which the launch points appear as discrete points, and the discrete points all have the latitude of 90° and thus are actually the same point in the spherical coordinate system. The above two embodiments both illustrate the feasibility and correctness of this method.









TABLE 3





Output parameters of positive-flying and negative-flying trajectories


constructed based on the two-body force model in Embodiment 1


(h = 10°; t0 = 56163.57313347)




















Positive-flying
vp (m/s)
7610.599
σ
a (m)
6026011.677



vr (m/s)
7691.680

i (°)
79.4004



à (°)
3.346

Ω (°)
164.8504



T (min)
35.45

ξ
−0.1828677






η
0.0002563






λ (°)
277.8481


Negative-flying
vp (m/s)
8520.429
σ
a (m)
7309475.919



vr (m/s)
8412.881

i (°)
103.3056



à (°)
−167.691

Ω (°)
350.2673



T (min)
78.82

ξ
−0.2153108






η
−0.0003193






λ (°)
223.0456
















TABLE 4





Output parameters of positive-flying and negative-flying trajectories


constructed when the J2 perturbation is considered in Embodiment 1


(h = 10°; t0 = 56163.57313347)






















Positive-
vp
(m/s)
7605.442
σ
a
(m)
6018859.853


flying


  ↓ 5.157



 ↓ 7151.82



vr
(m/s)
7686.569

i
(°)
      79.3943





  ↓ 5.111



      ↓ 0.0061



Ã
(°)
   3.358

Ω
(°)
     164.8623





  ↑ 0.012



      ↑ 0.0119














T
(min)
 35.44

ξ
         −0.1832377

















 ↓ 0.01



       ↓ 0.00037


















η
         −0.0009288





















       ↓ 0.00119







λ
(°)
     277.8532









      ↑ 0.0051


Negative-
vp
(m/s)
8517.134
σ
a
(m)
7302264.995


flying


  ↓ 3.295



 ↓ 7210.92



vr
(m/s)
8409.680

i
(°)
     103.2933





  ↓ 3.201



      ↓ 0.0123



Ã
(°)
−167.718

Ω
(°)
     350.2419





  ↓ 0.027



      ↓ 0.0254














T
(min)
 78.95

ξ
         −0.2148064





 ↑ 0.13


        ↑ 0.000504







η
         −0.0010205





















      ↓ 0.0007







λ
(°)
     223.0432









      ↓ 0.0024









IV. Definition of the Symbols and Variables Involved
















Symbol
Definition
Explanation







Known
t0
launch epoch



quantities
h
launch angle (or specified launch angle,
specified value




whose value can be specified as any real
0 < h < 90°




number within an allowable range)




LA, BA, HA
geodetic longitude, latitude and height of
when the point is




the launch point A
located at the north or



LB, BB, HB
geodetic longitude, latitude and height of
south pole, the




the target point B
longitude is assigned





any value in the range





of 0-360°


Constants
{right arrow over (R)}A(XA, YA, ZA)
rectangular coordinate vector of the point A



during

in the body-fixed coordinate system



iteration
{right arrow over (R)}B(XB, YB, ZB)
rectangular coordinate vector of the point B





in the body-fixed coordinate system




{right arrow over (r)}A(xA, yA, zA)
rectangular coordinate vector of the point A





in the TEMEE coordinate system




ε
difference between the ratio of the modulus





of the geocentric radius vector of the point A





to the modulus of the geocentric radius





vector of the point B and 1




q
zenith angle of the target point in the





conventional horizontal coordinate system





of the launch point




ϕ
horizontal angle between the AB direction





and the north-pole direction of the point A





when the point A is not at or above the north





or south pole




Δφ
difference between the geodetic latitude and





the geocentric latitude of the point A



Variables
T
flight time
with an initial value of


during


0


iteration
A*
launch azimuth in the target-pointing
with an initial value of




horizontal coordinate system
0



β
half-range angle




{right arrow over (r)}B(xB, yB, zB)
rectangular coordinate vector of the point B





in the TEMEE coordinate system





custom-character
A ({dot over (X)}A, {dot over (Y)}A, ŻA)

rectangular coordinate vector of the launch





velocity in the body-fixed coordinate





system





custom-character
A ({dot over (x)}A, {dot over (y)}A, żA)

rectangular coordinate vector of the launch





velocity in the TEMEE coordinate system




vp
modulus of the launch velocity vector in the
vp = | custom-characterA|




body-fixed coordinate system




vr
modulus of the launch velocity vector in the
vr = | custom-characterA|




TEMEE coordinate system




σ
first type of non-singular orbital elements at
6 components,




the launch epoch
including





a, i, Ω, ξ, η, λ



ω
argument of perigee of the orbit




Δω
bias of the argument of perigee




fA fB
true anomalies of the points A and B on the





elliptical trajectory/orbit




uA uB
true arguments of latitude of the points A





and B on the elliptical trajectory/orbit




α
intersection angle between the launch





velocity vector and the geocentric radius





vector of the launch point in the body-fixed





coordinate system




θ
intersection angle between the launch





velocity vector and the geocentric radius





vector of the launch point in the TEMEE





coordinate system





custom-characterA*(X*, Y*, Z*)

launch velocity vector in the target-pointing





horizontal coordinate system




Ã
declination of the launch velocity vector in
west declination:




the target-pointing horizontal coordinate
negative; east




system relative to the target point in the
declination: positive




horizontal plane










Output
vp, vr, Ã, T, σ
the definition of each


quantities

symbol is given above









In addition, the present invention involves the following geophysical constants: the equatorial radius of the reference ellipsoid αe=6378136 m, the geocentric gravitational constant μ=0.39860043770442×1015 m3/s2, the oblateness of the earth f=1/298.25781, and the eccentricity of the meridian of the earth ec2=2f−f2=0.0066946.

Claims
  • 1. A method for constructing a free trajectory of a ballistic missile at a specified launch angle based on a two-body force model, comprising: step 1: data preprocessing: sequentially computing a body-fixed rectangular coordinate vector {right arrow over (R)}A of a launch point A and a body-fixed rectangular coordinate vector {right arrow over (R)}B of a target point B, a difference Δ100 between a geodetic latitude and a geocentric latitude of the launch point A, a horizontal angle ϕ between an AB direction and a north-pole direction of the launch point A in a body-fixed coordinate system, and a difference ε between a ratio of a modulus of geocentric radius vector of the launch point A to a modulus of a geocentric radius vector of the target point B and 1;step 2: setting of an initial state of iterations: assuming that the earth does not rotate and a flight time T is zero;step 3: computing, in the two-body force model, a launch velocity vector {right arrow over ({dot over (r)})}A of a positive-flying trajectory or a negative-flying trajectory in a True Equator Mean Equinox of Epoch (TEMEE) coordinate system and a launch velocity vector {right arrow over ({dot over (R)})}A of the positive-flying trajectory or the negative-flying trajectory in the body-fixed coordinate system, a first type of non-singular orbital elements σ of the ballistic missile at a launch epoch, and the flight time T to generate a new flight time T*; andstep 4: letting T=T*, repeating step 3 to iteratively compute the launch velocity vector {right arrow over ({dot over (r)})}A and the launch velocity vector {right arrow over ({dot over (R)})}A of the ballistic missile, the first type of non-singular orbital elements of the ballistic missile at the launch epoch, a half-range angle and the flight time until |T−T*| is less than a set threshold St to complete the iterations to finally obtain the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T of the ballistic missile in the two-body force model, and outputting designed parameters vp, vr, Ã, T, σ, wherein vp is a modulus of the launch velocity vector in the body-fixed coordinate system, vr is a modulus of the launch velocity vector in the TEMEE coordinate system, and à is a declination of a launch velocity vector in a target-pointing horizontal coordinate system relative to the target point B in a horizontal plane.
  • 2. A method for constructing a free trajectory of a ballistic missile at a specified launch angle considering both a central gravity and a J2 perturbation of the earth based on a result of a two-body force model, comprising: step 1: data preprocessing: sequentially computing a body-fixed rectangular coordinate vector {right arrow over (R)}A of a launch point A and a body-fixed rectangular coordinate vector {right arrow over (R)}B of a target point B, a difference Δφ between a geodetic latitude and a geocentric latitude of the launch point A, a horizontal angle ϕ between an AB direction and a north-pole direction of the launch point A in a body-fixed coordinate system, and a difference ε between a ratio of a modulus of the geocentric radius vector of the launch point A to a modulus of the geocentric radius vector of the target point B and 1;step 2: setting of an initial state of iterations: assuming that the earth does not rotate and a flight time T is zero;step 3: computing, in the two-body force model, a launch velocity vector {right arrow over ({dot over (r)})}A of a positive-flying trajectory or a negative-flying trajectory in a True Equator Mean Equinox of Epoch (TEMEE) coordinate system and a launch velocity vector {right arrow over ({dot over (R)})}A of the positive-flying trajectory or the negative-flying trajectory in the body-fixed coordinate system, a first type of non-singular orbital elements σ of the ballistic missile at a launch epoch and the flight time T to generate a new flight time T*; andstep 4: letting T=T*, repeating step 3 to iteratively compute the launch velocity vector of the ballistic missile, the first type of non-singular orbital elements of the ballistic missile at the launch epoch, a half-range angle and the flight time until |T−T*| is less than a set threshold St to complete the iterations to finally obtain the launch velocity vector {right arrow over ({dot over (r)})}A and the flight time T of the ballistic missile in the two-body force model;step 5: taking the launch velocity vector {right arrow over ({dot over (r)})}A the flight time T obtained by the two-body force model as reference solutions {right arrow over ({dot over (r)})}A0 and T0 for a differential correction; if a distance |Δ{right arrow over (R)}BB*| between the target point B and a target point B* obtained by a perturbation extrapolation based on the reference solutions is less than a given threshold SR, ending a correction of designed parameters of the ballistic missile and outputting corrected parameters vp, vr, Ã, T, σ, wherein vp is a modulus of the launch velocity vector in the body-fixed coordinate system, vr is a modulus of the launch velocity vector in the TEMEE coordinate system, and à is a declination of a launch velocity vector in a target-pointing horizontal coordinate system relative to the target point B in a horizontal plane; otherwise, proceeding to step 6; andstep 6: establishing a constraint equation with a constant launch angle and a differential equation based on a position error propagation of the target point B; computing a launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and a flight time increment ΔT, and denoting corrected solutions as and {circumflex over (T)}; taking the corrected solutions as reference solutions for a next differential correction by letting {right arrow over ({dot over (r)})}A0=, T0={circumflex over (T)} and repeating step 5.
  • 3. The method according to claim 1, wherein step 1 specifically comprises: 3.1: transforming geodetic coordinates of the launch point A and the target point B from spherical coordinates (L, B, H) to 3D rectangular coordinates (X, Y, Z) according to equation (1), and expressing the 3D rectangular coordinates by {right arrow over (R)}A and {right arrow over (R)}B as;
  • 4. The method according to claim 1, wherein step 3 specifically comprises: 4.1: computing coordinate vectors {right arrow over (r)}A and {right arrow over (r)}B of the launch point A and the target point B in the TEMEE coordinate system in combination with the flight time T according to equation (7):
  • 5. The method according to claim 1, wherein step 4 specifically comprises: 5.1: judging whether |T−T*|<St is satisfied; if yes, letting T=T*, and proceeding to a next step; otherwise, letting T=T*, and returning to step 3;5.2: computing the declination à of the launch velocity vector in the target-pointing horizontal coordinate system relative to the target point B in the horizontal plane according to equation (28):
  • 6. The method according to claim 2, wherein step 5 specifically comprises: 6.1: denoting the target point obtained by the perturbation extrapolation based on the reference solutions {right arrow over ({dot over (r)})}A0 and T0 as B*, and computing partial derivative matrices
  • 7. The method according to claim 2, wherein step 6 specifically comprises: 7.1: establishing a system of linear differential equations of the launch velocity vector increment Δ{right arrow over ({dot over (r)})}A and the flight time increment ΔT according to equations (39) to (41):
  • 8. The method according to claim 2, wherein step 1 specifically comprises: 3.1: transforming geodetic coordinates of the launch point A and the target point B from spherical coordinates (L, B, H) to 3D rectangular coordinates (X, Y, Z) according to equation (1), and expressing the 3D rectangular coordinates by {right arrow over (R)}A and {right arrow over (R)}B as;
  • 9. The method according to claim 2, wherein step 3 specifically comprises: 4.1: computing coordinate vectors {right arrow over (r)}A and {right arrow over (r)}B of the launch point A and the target point B in the TEMEE coordinate system in combination with the flight time T according to equation (7):
  • 10. The method according to claim 2, wherein step 4 specifically comprises: 5.1: judging whether |T−T*|<St is satisfied; if yes, letting T=T*, and proceeding to a next step; otherwise, letting T=T*, and returning to step 3;5.2: computing the declination à of the launch velocity vector in the target-pointing horizontal coordinate system relative to the target point B in the horizontal plane according to equation (28):
Priority Claims (1)
Number Date Country Kind
201910941400.5 Sep 2019 CN national
CROSS REFERENCE TO THE RELATED APPLICATIONS

This application is the national phase entry of International Application No. PCT/CN2020/102341, filed on Jul. 16, 2020, which is based upon and claims priority to Chinese Patent Application No. 201910941400.5, filed on Sep. 30, 2019, the entire contents of which are incorporated herein by reference.

PCT Information
Filing Document Filing Date Country Kind
PCT/CN2020/102341 7/16/2020 WO 00