Laplace extremely short arc orbit determination algorithm based on particle swarm optimization
Through the extremely short arc orbital orbital algorithm combined with the particle swarm algorithm and the Laplace method, the problem of accuracy and complexity in the spacecraft's short arc orbital orbital calculation is solved, and higher orbital accuracy and applicability are achieved.
Patent Information
- Application Number
- CN202411350775.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-26
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-09-26
AI Technical Summary
The existing spacecraft short-arc orbital algorithms have shortcomings in accuracy and computational complexity, especially in extremely short-arc orbital calculations, it is difficult to effectively eliminate field values and residuals, and it also requires high requirements for dynamic models.
The Laplace extremely short arc orbital algorithm based on particle swarm algorithm is used to calculate Kepler parameters and orbital position vectors through particle swarm algorithm, and the Laplace method and least squares algorithm are used to correct it to eliminate the field values and residuals. Poor, improve the accuracy of tracking.
It realizes the accuracy and applicability of the orbital in extremely short arc fixed orbital calculation, which can effectively eliminate the influence of field values and residuals, and improve the accuracy of multi-vector fixed orbital calculation.
Smart Images

Figure CN118936482A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of spacecraft short arc orbit determination calculation, in particular to a Laplace extremely short arc orbit determination algorithm based on a particle swarm algorithm. Background Art
[0002] When space-based detection satellites use cameras to observe space targets, they photograph space targets with stars as the background. Since the direction of the stars is known, the relative position of the space target and the stars on the image can be measured using a coordinate measuring instrument to obtain the orientation information of the space target. Although the optical payload can be used to detect space targets to obtain angle measurements, the distance between the detector and the debris cannot be obtained, and the target needs to be catalogued within the observation data under a short observation time. This puts certain requirements on the input of the algorithm, that is, to perform extremely short arc orbit determination on the target in a limited number of observation directions.
[0003] At present, there are different orbit determination methods for different measurement stations (single or multiple) and different properties of the measured quantities (position, velocity, angle). For extremely short arc orbit determination, the common ones are Kepler element method, differential correction method, optimization algorithm and extended Kalman filter algorithm. Although the Kepler element method is fast in calculation and simple in principle, it has low accuracy and is difficult to eliminate outliers. The differential correction method and optimization algorithm have the disadvantage of high computational complexity, and the extended Kalman filter algorithm requires the original dynamic model to have high accuracy.
[0004] Therefore, a Laplace extremely short arc orbit determination algorithm based on particle swarm optimization is urgently needed to solve the above problems. Summary of the invention
[0005] To solve the above problems, the present application provides a Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm, which aims at fast extremely short arc orbit determination and aims to eliminate the influence of outliers and residuals, thereby achieving the purpose of accurate orbit determination.
[0006] In this application, a Laplace extremely short arc orbit determination algorithm based on a particle swarm algorithm is provided, comprising the following steps:
[0007] S1. Obtain the coordinate position vector of the observation satellite at each moment and its observed direction vector, and use the particle swarm algorithm to calculate the initial value of the Kepler parameters (a, e, M) corresponding to the direction vector at each moment, and its corresponding target position vector in the inertial system;
[0008] S2. Use the Laplace method and least squares algorithm to determine the orbit, correct and eliminate wild values of the target position vector at each moment obtained in S1, and calculate the orbit parameters corresponding to the short arc segment and the true near angle corresponding to each moment.
[0009] Preferably, the specific steps of S1 are as follows:
[0010] S101: Obtain three variables within the range of Kepler parameters to obtain particle swarm algorithm variables and define the three variables as initial values of Kepler parameters (a, e, M);
[0011] S102: Calculate the mean near angle and its corresponding true near angle at each moment according to the Kepler parameter value, and calculate the position vector modulus of the target according to the mean near angle and its corresponding true near angle;
[0012] S103: Obtain the direction vector obtained by observation and the coordinate position vector of the observed satellite and calculate the angle between the two to obtain an initial estimated value of the position vector of the target satellite;
[0013] S104: Calculate the target fitness function corresponding to the particle swarm algorithm according to the initial estimated value of the position vector obtained in S103, and update the particle swarm algorithm variables;
[0014] S105: Repeat the operations from S101 to S103, perform iterations, obtain the optimal target fitness function value, and output the initial value of the Kepler parameter and the position vector value at each moment.
[0015] Preferably, in step S102, the calculation expressions of the near angle and the modulus are as follows:
[0016] M i =M0+n(t i -t0);
[0017] |R i |=a(1-ecosf i );
[0018] Where M is the mean angle, n is the average angular velocity of the orbit, a is the semi-major axis of the orbit, e is the eccentricity, and R is the target position vector. is the true near angle, and i is the position index.
[0019] Preferably, the expression used in S103 to calculate the position vector value is as follows:
[0020]
[0021] R i =ρ i ×nj i +r i ;
[0022] Among them, r i is the coordinate vector of the observation satellite in the geocentric inertial system, nj i is the direction vector observed for the target, β is the angle between the two vectors, is the estimated value of the position vector under Kepler parameters, ρ i is the estimated value of the radial vector modulus from the observation satellite to the target satellite.
[0023] Preferably, the expression of the objective fitness function in S104 is as follows:
[0024]
[0025] Among them, R is the calculated position vector, F is the particle swarm fitness value corresponding to each iteration, and N is the number of observation moments.
[0026] Preferably, the specific steps of S2 are as follows:
[0027] S201: using polynomial curve smoothing fitting to correct position vector values at several moments;
[0028] S202: Obtain the position and velocity information at time t0, and calculate the initial value of the orbit semi-major axis, the mean angle value, the eccentric angle value, the parameter p and the parameter The initial value of
[0029] S203: using the values obtained in S202, calculating the Laplace function value, and performing orbit extrapolation to obtain the position vector value and the velocity vector value at several moments;
[0030] S204: Substitute the position vector values at several moments into S201, repeat the contents of S201 to S203, perform iterative calculation, and obtain Exact value and Exact value;
[0031] S205: Calculate a number of orbital elements using the position vector and velocity vector values and perform orbit determination.
[0032] Preferably, the specific content of the polynomial curve smooth fitting in S201 is:
[0033] Get the initial position vector at the moment and the velocity vector
[0034] The polynomial fitting function is used for fitting;
[0035] The expression of the polynomial fitting function is:
[0036]
[0037] Among them, R is the position vector value, t is the time value, d is the position vector at each time, and j is the position index.
[0038] Preferably, the Laplace function expression used in S203 is:
[0039]
[0040] Among them, V is the velocity of the target, and f, g, F, and G are Laplace operators.
[0041] Preferably, the orbital extrapolation expression in S203 is as follows:
[0042]
[0043] Among them, a is the semi-major axis of the orbit, r0 is the modulus value of the position vector, v0 is the modulus value of the velocity vector, and p is the modulus value of the Laplace vector.
[0044] Preferably, during the iterative calculation in S204, when as well as , the iteration is terminated.
[0045] In summary, the Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm of the present invention is composed of particle swarm algorithm, Laplace method of orbit extrapolation and least squares algorithm compared with the traditional spacecraft short arc orbit determination calculation technology. The particle swarm algorithm is used to complete the preliminary calculation of the direction vector to the Kepler constant and the position information at each moment. The orbit data of the observation vector is corrected by the Laplace method and the least squares method to eliminate the influence of wild values and residuals. The two are iterated with each other to obtain more accurate orbit parameter values, which improves the traditional orbit determination calculation of particle swarm algorithm, improves the accuracy of multi-vector orbit determination calculation, and has good applicability.
[0046] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS
[0047] Figure 1 This is a flow chart of a Laplace extremely short arc orbit determination algorithm based on a particle swarm algorithm of the present invention;
[0048] Figure 2 This is an example result diagram of orbit calculation of a Laplace very short arc orbit determination algorithm based on a particle swarm algorithm in the present invention. DETAILED DESCRIPTION
[0049] The technical solution of the present invention is further described below by means of the accompanying drawings and embodiments. It should be noted that unless otherwise specifically stated, the relative arrangement of components and steps, numerical expressions and numerical values described in these embodiments do not limit the scope of the present application.
[0050] The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the present application, its application, or uses.
[0051] Technologies, methods, and equipment known to ordinary technicians in the relevant art may not be discussed in detail, but where appropriate, the technologies, methods, and equipment should be considered part of the specification.
[0052] In all examples shown and discussed herein, any specific values should be interpreted as merely exemplary and not limiting. Therefore, other examples of the exemplary embodiments may have different values.
[0053] Unless otherwise defined, technical or scientific terms used in the present invention shall have the common meanings understood by one having ordinary skills in the field to which the present invention belongs.
[0054] like Figure 1 As shown, the present invention provides a Laplace extremely short arc orbit determination algorithm based on a particle swarm algorithm, which is specifically as follows: S1, obtaining the coordinate position vector of the observed satellite at each moment and the direction vector obtained by observation, and using the particle swarm algorithm to calculate the Kepler parameter initial value (a, e, M) corresponding to the direction vector at each moment, and the target position vector corresponding to it in the inertial system.
[0055] Furthermore, the specific steps of S1 are as follows: S101: Obtain three variables within the range of Kepler parameters to obtain particle swarm algorithm variables and define the three variables as initial values (a, e, M) of Kepler parameters.
[0056] S102: Calculate the mean near angle and its corresponding true near angle at each moment according to the Kepler parameter value, and calculate the position vector modulus of the target according to the mean near angle and its corresponding true near angle.
[0057] Furthermore, in step S102, the expressions for calculating the near angle and the modulus are as follows:
[0058] M i =M0+n(t i -t0).
[0059] |R i |=a(1-ecosf i ).
[0060] Where M is the mean angle, n is the average angular velocity of the orbit, a is the semi-major axis of the orbit, e is the eccentricity, and R is the target position vector. is the true near angle, and i is the position index.
[0061] S103: Obtain the observed direction vector and the coordinate position vector of the observed satellite and calculate the angle between the two to obtain an initial estimated value of the position vector of the target satellite.
[0062] Furthermore, the expression used in S103 to calculate the position vector value is as follows:
[0063]
[0064] R i =ρ i ×nj i +r i .
[0065] Among them, r i is the coordinate vector of the observation satellite in the geocentric inertial system, nj i is the direction vector observed for the target, β is the angle between the two vectors, is the estimated value of the position vector under Kepler parameters, ρ i is the estimated value of the radial vector modulus from the observation satellite to the target satellite.
[0066] S104: According to the initial estimated value of the position vector obtained in S103, the target fitness function corresponding to the particle swarm algorithm is calculated, and the particle swarm algorithm variables are updated.
[0067] Furthermore, the expression of the objective fitness function in S104 is as follows:
[0068]
[0069] Among them, R is the calculated position vector, F is the particle swarm fitness value corresponding to each iteration, and N is the number of observation moments.
[0070] S105: Repeat the operations from S101 to S103, perform iterations, obtain the optimal target fitness function value, and output the initial value of the Kepler parameter and the position vector value at each moment.
[0071] Furthermore, S2 uses the Laplace method and the least squares algorithm to determine the orbit, correct and eliminate the wild value of the target position vector at each moment obtained in S1, and calculate the orbit parameters corresponding to the short arc segment and the true near angle corresponding to each moment.
[0072] The formula used is as follows:
[0073] n=a -3 / 2 .
[0074] ΔM=n(t i -t0).
[0075]
[0076] p=a(1-e 2 ).
[0077] Where M is the mean angle, n is the average angular velocity of the orbit, a is the semi-major axis of the orbit, e is the eccentricity, and R is the target position vector. True near angle.
[0078] In order to obtain the change value of the near angle ΔE, the relationship between the near angle and the near angle is Use Newton's iteration method to find the value of ΔE. The following is the iteration formula of E. After calculating the corresponding E value, subtract it to find the value of ΔE:
[0079] Furthermore, the specific steps of S2 are as follows: S201, using polynomial curve smoothing fitting to correct the position vector values at several moments.
[0080] Furthermore, the specific content of the polynomial curve smooth fitting in S201 is: obtaining the initial position vector at the time and the velocity vector
[0081] The polynomial fitting function is used for fitting.
[0082] The expression of the polynomial fitting function is: (j=1,2,...,n).
[0083] Among them, R is the position vector value, t is the time value, d is the position vector at each time, and j is the position index.
[0084] S202: Obtain the position and velocity information at time t0, and calculate the initial value of the orbit semi-major axis, the mean angle value, the eccentric angle value, the parameter p and the parameter The initial value of .
[0085] S203: Using the values obtained in S202, the Laplace function value is calculated, and the orbit is extrapolated to obtain the position vector value and the velocity vector value at several moments.
[0086] Furthermore, the Laplace function expression used in S203 is:
[0087] Among them, V is the velocity of the target, and f, g, F, and G are Laplace operators.
[0088] Furthermore, the orbital extrapolation expression in S203 is as follows:
[0089]
[0090] Among them, a is the semi-major axis of the orbit, r0 is the modulus value of the position vector, v0 is the modulus value of the velocity vector, and p is the modulus value of the Laplace vector.
[0091] S204: Substitute the position vector values at several moments into S201, repeat the contents of S201 to S203, perform iterative calculation, and obtain Exact value and The exact value, when as well as , the iteration is terminated.
[0092] S205: Calculate a number of orbital elements using the position vector and velocity vector values and perform orbit determination.
[0093] Traditional methods for short-arc orbit determination include the dual-vector orbit determination algorithm and the Hibbert-Gibbs orbit determination algorithm.
[0094] The double vector orbit determination algorithm uses the Gaussian FG function to solve the target orbit. When the measurement time interval is small and the dynamic model is accurate, the velocity of the object is roughly solved first, and then the orbit parameters of the space object are calculated. The general algorithm is as follows: First, the approximate velocity of the space object is calculated.
[0095]
[0096] Using the position vectors r1 and r2 measured at two times t1 and t2, v1 is calculated using the following formula.
[0097] v1=[r2-F(r1,v1,τ)r1] / G(r1,v1,τ).
[0098] in:
[0099]
[0100] τ=t2-t1.
[0101] where F and G are Gaussian functions of orbital dynamics expansion.
[0102] Because the time interval is short, v1 is first used as an assumed value to calculate the F and G function values, and then a new v1 is calculated using the above formula, and the new F and G function values are calculated again and again, and the cycle is repeated until v1 meets the accuracy requirements. At this time, r1 and v1 are calculated in the Earth's inertial coordinate system to obtain the orbital parameters of the object without maneuverability. Although the double-vector orbit determination uses less data, its orbit determination accuracy will often have a large deviation due to the inaccuracy of the model order, the deviation and disturbance of the dynamic model, and the influence of observation error noise.
[0103] The Hibbert-Gibbs orbit determination algorithm solves the initial position and velocity of the target through multiple vectors, and then solves the orbit parameters of the target. The specific formula is as follows:
[0104]
[0105] in is the position and velocity vector value at each moment.
[0106] After solving the specific initial values of position and velocity, the specific values of orbital parameters are solved.
[0107] The following is a simulation of the extremely short arc orbit determination algorithm. The target satellite is a near-Earth satellite with a circular orbit and an orbital radius of 7200km. The observation frequency set for the target is 10Hz, the observation time is 3s, and there is a large observation error. This method and the above-mentioned dual-vector orbit determination and Hibbert-Gibbs orbit determination algorithm are used to perform extremely short arc orbit determination on the target. The orbit determination results are shown in the following table and Figure 2 shown.
[0108] Table 1 Comparison of orbital parameters obtained by various methods
[0109]
[0110] Compared with the traditional orbit determination algorithm, this method considers a larger data range, and maintains a certain observation accuracy under a large observation error, and the error is within an acceptable range. However, due to the existence of observation errors, the two-vector orbit determination and Hibbert-Gibbs orbit determination methods have large deviations, and the accuracy is greatly disturbed by the errors. This method can effectively eliminate the influence of outliers and disturbances. The number of sampling points and the sampling frequency can be increased to further improve the accuracy of observations.
[0111] The orbit parameter values output by the extremely short arc orbit determination can provide good initial values for precise orbit determination algorithms and orbit catalog identification.
[0112] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that they can still modify or replace the technical solution of the present invention with equivalents, and these modifications or equivalent replacements cannot cause the modified technical solution to deviate from the spirit and scope of the technical solution of the present invention.
Claims
1. A Laplace extremely short arc orbit determination algorithm based on particle swarm optimization, characterized in that: The following steps are involved: S1. Obtain the coordinate position vector of the observation satellite at each moment and its observed direction vector, and use the particle swarm algorithm to calculate the initial value of the Kepler parameters (a, e, M) corresponding to the direction vector at each moment, and its corresponding target position vector in the inertial system; S2. Use the Laplace method and least squares algorithm to determine the orbit, correct and eliminate wild values of the target position vector at each moment obtained in S1, and calculate the orbit parameters corresponding to the short arc segment and the true near angle corresponding to each moment.
2. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 1, characterized in that: The specific steps of S1 are as follows: S101: Obtain three variables within the range of Kepler parameters to obtain particle swarm algorithm variables and define the three variables as initial values of Kepler parameters (a, e, M); S102: Calculate the mean near angle and its corresponding true near angle at each moment according to the Kepler parameter value, and calculate the modulus of the target position vector according to the mean near angle and its corresponding true near angle; S103: Obtain the direction vector obtained by observation and the coordinate position vector of the observed satellite and calculate the angle between the two to obtain an initial estimated value of the position vector of the target satellite; S104: Calculate the target fitness function corresponding to the particle swarm algorithm according to the initial estimated value of the position vector obtained in S103, and update the particle swarm algorithm variables; S105: Repeat the operations from S101 to S103, perform iterations, obtain the optimal target fitness function value, and output the initial value of the Kepler parameter and the position vector value at each moment.
3. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 2, characterized in that: In step S102, the expression for calculating the near angle is as follows: M i =M0+n(t i -t0); Where M is the mean angle, n is the average angular velocity of the orbit; The calculation expression of the modulus length is as follows: |R i |=a(1-ecosf i ); Where a is the semi-major axis of the orbit, e is the eccentricity, R is the target position vector, is the true near angle, and i is the position index.
4. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 2, characterized in that: The expression used to calculate the initial estimated value of the position vector of the target satellite in S103 is as follows: R i =ρ i ×nj i +r i ; Among them, r i is the coordinate vector of the observation satellite in the geocentric inertial system, nj i is the direction vector observed for the target, β is the angle between the two vectors, is the estimated value of the position vector under Kepler parameters, ρ i is the estimated value of the radial vector modulus from the observation satellite to the target satellite.
5. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 2, characterized in that: The expression of the objective fitness function in S104 is as follows: Among them, R is the calculated position vector, F is the particle swarm fitness value corresponding to each iteration, and N is the number of observation moments.
6. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 1, characterized in that: The specific steps of S2 are as follows: S201: using polynomial curve smoothing fitting to correct position vector values at several moments; S202: Obtain the position and velocity information at time t0, and calculate the initial value of the orbit semi-major axis, the mean angle value, the eccentric angle value, the parameter p and the parameter The initial value of S203: using the values obtained in S202, calculating the Laplace function value, and performing orbit extrapolation to obtain the position vector value and the velocity vector value at several moments; S204: Substitute the position vector values at several moments into S201, repeat the contents of S201 to S203, perform iterative calculation, and obtain Exact value and Exact value; S205: Calculate a number of orbital elements using the position vector and velocity vector values and perform orbit determination.
7. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 6, characterized in that: The specific content of polynomial curve smooth fitting in S201 is: Get the initial position vector at the moment and the velocity vector The polynomial fitting function is used for fitting; The expression of the polynomial fitting function is: Among them, R is the position vector value, t is the time value, d is the position vector at each time, and j is the position index.
8. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 6, characterized in that: The Laplace function expression used in calculating the Laplace function value in S203 is: Among them, V is the velocity of the target, and f, g, F, and G are Laplace operators.
9. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 6, characterized in that: The orbital extrapolation expression in S203 is: Among them, a is the semi-major axis of the orbit, r0 is the modulus value of the position vector, v0 is the modulus value of the velocity vector, and p is the modulus value of the Laplace vector.
10. The Laplace extremely short arc orbit determination algorithm based on particle swarm algorithm according to claim 6, characterized in that: During the iterative calculation process in S204, when as well as , the iteration is terminated.
Citation Information
Patent Citations
Short-arc initial orbit determination method based on Gauss solution group optimization
CN110017832A
Double-arc-segment orbit improvement method based on short arc fitting position
CN113297745A
Satellite orbit determination method and device based on space-based observation
CN115544648A
Space debris short arc angle measurement-only initial orbit determination optimization method based on improved Laplace model
CN115774928A
Track determination method based on optical short arc track association
CN117664146A
