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.
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.
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.
According to the present invention, referring to
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:
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):
3. The difference Δφ between the geodetic latitude and the geocentric latitude of the point A is computed according to 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):
wherein, q is the zenith angle of the point B from the zenith of the point A and is computed by:
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:
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):
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,
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):
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:
then the half-range angle is computed by:
3. An inclination i and a right ascension Ω of an ascending node of an elliptical trajectory/orbit are computed according to 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):
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):
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):
wherein,
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:
wherein,
wherein μA and μB have been computed according to equation (11); Δω is computed according to equation (15):
accordingly, true anomalies of the points A and B on the elliptical trajectory/orbit are expressed by Δω as follows:
8. An eccentricity e of the elliptical trajectory/orbit is computed according to 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:
then the specified launch angle is judged to be excessively large; and
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:
wherein MA is computed as follows:
12. The flight time T* of the missile is computed according to 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:
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:
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):
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
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:
derive initial values as:
integrate from t=t0 to t=t0+T0 to obtain:
the force function {right arrow over (F)}({right arrow over (r)}) only including the J2 perturbation and its partial derivative matrix
in equation (29) are expressed as:
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:
Accordingly, the gradient and tensor of the gravitational potential function U of the earth are obtained as follows:
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:
wherein,
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):
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:
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 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=, 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):
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:
wherein, G is a 1×3 matrix, C is a 3×3 matrix, D is a 3×1 matrix, which are expressed as:
wherein,
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 and {circumflex over (T)} are obtained according to 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=, 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.
2. TEMEE Coordinate System
As shown in
3. Conventional Horizontal Coordinate System and Target-Pointing Horizontal Coordinate System
As shown in
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:
wherein, θg is computed by:
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:
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:
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.
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.
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:
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):
3. The difference Δ100 between the geodetic latitude and the geocentric latitude of the point A is computed according to 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):
wherein, q is the zenith angle of the point B from the zenith of the point A, and is computed by:
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:
Equations (4) and (5) are derived from the formulas of spherical trigonometry applied to the spherical triangle O-PZAZB in
Angular distance ∠POZA represents the complementary angle of the geodetic latitude of the point A and is equal to
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:
simplified as the following equations for computing ϕ:
According to the law of cosines of spherical trigonometry, q is expressed by:
rewritten as:
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):
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,
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):
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:
then the half-range angle is computed by:
3. The inclination i and the right ascension Ω of the ascending node of the elliptical trajectory/orbit are computed according to 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):
Equation (11) is derived from the law of sines applied to the spherical triangles in
Similarly, in the spherical triangle O-KBB′,
The half-range angle β is known and μB=μA+2β is satisfied, which is substituted into the above equations to obtain:
The expressions of sin μA and sin μB are substituted to obtain:
simplified as:
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):
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
∠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:
{tilde over (α)} and Θ are substituted into the above equation to obtain:
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):
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:
simplified as:
Because |{right arrow over ({dot over (r)})}A|=vr; |{right arrow over ({dot over (R)})}A|=vp, the above equation can be rewritten as:
wherein, 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, 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:
wherein,
wherein μA and μB have been computed according to equation (11); Δω is computed according to equation (15):
accordingly, the true anomalies of the points A and B on the elliptical trajectory/orbit are expressed by Δω as follows:
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:
wherein, p is a semi-laths rectum. The polar radii of the points A and B are:
rA=|{right arrow over (R)}A| and rB=|{right arrow over (R)}B| are substituted into equation (6) to obtain:
rewritten as:
The expressions of fA and fB in equation (16) are substituted to obtain:
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).
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:
rewritten as:
fA=π−β−Δω is substituted into the above equation to obtain:
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:
then the specified launch angle is judged to be excessively large; and
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:
wherein MA is computed as follows:
12. The flight time T* of the missile is computed according to 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:
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:
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):
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
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:
derive initial values as:
integrate from t=t0 to t=t0+T0 to obtain:
the force function {right arrow over (F)}({right arrow over (r)}) only including the J2 perturbation and its partial derivative matrix
in equation (29) are expressed as:
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:
Accordingly, the gradient and tensor of the gravitational potential function U of the earth are obtained as follows:
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:
wherein,
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):
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:
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 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=, 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):
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:
wherein, G is a 1×3 matrix, C is a 3×3 matrix, D is a 3×1 matrix, which are expressed as:
wherein,
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 and {circumflex over (T)} are obtained according to 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=, 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.
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.
IV. Definition of the Symbols and Variables Involved
A ({dot over (X)}A, {dot over (Y)}A, ŻA)
A ({dot over (x)}A, {dot over (y)}A, żA)
A*(X*, Y*, Z*)
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.
Number | Date | Country | Kind |
---|---|---|---|
201910941400.5 | Sep 2019 | CN | national |
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.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2020/102341 | 7/16/2020 | WO | 00 |