CN109375648B - Elliptical orbit satellite formation configuration initialization method under multi-constraint condition - Google Patents
Elliptical orbit satellite formation configuration initialization method under multi-constraint condition Download PDFInfo
- Publication number
- CN109375648B CN109375648B CN201811492401.8A CN201811492401A CN109375648B CN 109375648 B CN109375648 B CN 109375648B CN 201811492401 A CN201811492401 A CN 201811492401A CN 109375648 B CN109375648 B CN 109375648B
- Authority
- CN
- China
- Prior art keywords
- constraint
- equation
- coordinate system
- orbit
- optimal control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Abstract
The invention discloses an initialization method for formation configuration of an elliptic orbit satellite under a multi-constraint condition, relates to an initialization method for formation configuration of a satellite, and belongs to the field of guidance and control of spacecrafts. The implementation method of the invention comprises the following steps: through classical orbit dynamics and coordinate transformation, deducing to obtain an analytic solution of a true-near-point angular domain T-H equation, analyzing dynamics constraint, periodically surrounding flight constraint, establishing monitoring camera view field constraint and thrust amplitude constraint, establishing a multi-constraint optimal control model of formation, solving through a Gaussian pseudo-spectrum method, obtaining a coordination value at any moment, realizing real-time monitoring on spacecraft structural integrity, and reducing fuel consumption and maximum amplitude of a propulsion system by increasing eccentricity and initialization time. The invention can realize the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition, and realize the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
Description
Technical Field
The invention relates to a satellite formation configuration initialization method, in particular to an optimal initialization method for building an elliptical orbit satellite formation under a multi-constraint condition, and belongs to the field of spacecraft guidance and control.
Background
In recent years, satellite formation technology has attracted attention for its wide future application. The satellite cluster formation flying technology based on the small satellites is generally concerned and accepted by relevant organizations in the fields of military affairs, industry, commerce, scientific research and the like due to the strong technical advantages and wide application prospects of the technology. The two-star formation is the most basic form of satellite formation, and the formation is composed of a master star and slave stars, and the slave stars surround the master star to perform on-orbit monitoring tasks, such as detecting whether the appearance structure of the master star and a solar panel are normal or not, so that the cost is reduced, and the risk of the astronauts for moving outside the cabin is reduced. Meanwhile, the fly-around monitoring is also an important helpful and key technology for realizing on-orbit services such as fuel filling, on-orbit maintenance, material supply, space rendezvous and the like for the target spacecraft. Therefore, the research on the design of the orbiting configuration of the satellite formation and the configuration initialization control is of great significance.
The configuration and control of the formation of the satellite are based on relative dynamics, and a circular orbit relative motion model is given by a C-W equation. When the orbit of the target spacecraft is an elliptical orbit, the C-W equation can introduce obvious errors due to the existence of the eccentricity of the orbit, and the T-H equation is adopted to describe the linear relative motion of the target spacecraft. However, since the T-H equation has obvious nonlinear characteristics in the time domain, the solution of the relative motion is difficult, and therefore the invention linearizes the T-H model through true paraxial angular domain transformation and deduces an analytic solution.
The control in the formation satellite release process generally adopts a thruster with limited amplitude, and in order to ensure the safety in the release process, a visible light camera is generally required to be used for monitoring, so the engineering constraint conditions need to be considered when the formation is initialized. The solution of the trajectory optimization problem can be essentially divided into an indirect method, a direct method and a mixed method. The indirect method strictly meets the first-order requirement of optimality in theory, but in the actual calculation process, due to the high sensitivity to initial guessing of the cooperative state, the convergence radius is small, and the solution is difficult, so the application is limited to a certain extent. Compared with an indirect method, the direct method can effectively avoid the solution of the cooperative state, and can effectively reduce the calculated amount by properly selecting the scale of the discrete nodes.
Disclosure of Invention
The invention discloses an initialization method for formation configuration of an elliptic orbit satellite under multi-constraint conditions, which aims to solve the technical problems that: and initializing the formation configuration of the elliptic orbit satellite under the multi-constraint condition, and realizing effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
The purpose of the invention is realized by the following technical scheme.
The invention discloses an initialization method for formation configuration of elliptic orbit satellites under multiple constraint conditions, which comprises the following steps:
the method comprises the following steps: and deducing to obtain the analytic solution of the true-near-point angular domain T-H equation through classical orbit dynamics and coordinate transformation.
Step 1.1: respectively establishing an inertia coordinate system and a track coordinate system;
and establishing a fixed inertial coordinate system with the earth as a center, wherein the X axis points to the spring equinox, the Z axis is consistent with the rotation axis direction of the earth, and the Y axis is determined according to the right-hand rule. And establishing an orbit coordinate system which takes the main star as a mass center and rotates relative to the origin, wherein the x axis of the orbit coordinate system points to the center of the main star from the center of the earth, the z axis is vertical to the orbit plane, and the y axis is determined according to the right-hand rule.
Step 1.2: obtaining an analytic solution according to classical orbit dynamics;
defining the relative position vector rho ═ r of the master star and the slave stard-rcWherein r isd∈R3And rc∈R3Respectively, the position vectors of the slave and master stars. The relative dynamics between the master and slave stars are expressed in the inertial reference frame as:
where μ represents a constant earth gravity coefficient and u ∈ R3Representing the actively controlled acceleration produced by a propeller fixed to the tracker. From the inertial reference system to the orbital coordinate system, equation (1) is approximately expressed as:
where ω is the orbital angular velocity of the main star and the subscript o denotes the vector described in the rotating orbital coordinate system. Substituting formula (1) into formula (2), the relative motion is expressed as
Wherein
Where f is the true proximal angle of the principal star. Finally, substituting equations (1) and (2) into equation (3) yields:
wherein
If the active control is omitted, equations (5) to (7) are the T-H equations. The T-H equation describes the relative dynamics of free flight orbits of the two spacecrafts, and the inner and outer motions of the orbital plane are decoupled. Due to the non-linearity of the T-H equation, it is difficult to find an analytical solution of the T-H equation in the time domain. Therefore, the T-H equation is rewritten by the following transformation:
taking the first and second derivatives of f,
the following operators are defined:
finally, substituting equations (9) to (13) into equations (5) to (7), the relative kinetics are re-expressed as:
obviously, the equations (14) - (15) are linearized and solved under the given initial conditions:
wherein
h and p are the angular momentum of the primary star and the positive semi-focal distance, respectively. c. Ci( i 1, 2.., 6) is the initial state and initial of the main starThe constant coefficient determined by the true paraxial point angle is calculated according to the following formula:
analytic solution of T-H equation intoNamely, the derivation is realized to obtain the analytic solution of the true near point angular domain T-H equation.
Step two: and deducing a periodic fly-around constraint condition, and establishing a monitoring camera view field constraint and a thrust amplitude constraint.
Step 2.1: deriving a periodic fly-around constraint in a true anomaly angle domain;
since the expressions (21) to (26) are all sinusoidal, for a given true paraxial angle f, if c4(f) Is equal to 0, i.e
It can be ensured that a periodic relative trajectory is obtained. Further, the following formulae (9), (10) and (27):
equation (28) is a prerequisite for a periodic trajectory in an arbitrary elliptical orbit, and if equation (27) is satisfied, the corresponding periodic relative motion is expressed as
However, since equation (27) cannot guarantee a periodic fly-around trajectory, equation (30) is rewritten as follows:
then, combining the formula (32) and the formula (29), the in-plane relative trajectory is represented as
When the in-plane trajectory flies around, the three-dimensional trajectory can be ensured to fly around. In formula (33), when c1When 0, the orbit is reduced to an ellipse centered at (0,0), and the half axis thereof changes with time. The periodic fly-around constraint is described as:
where k is a coefficient selected according to the orbit around, k may be set to zero if it is desired to follow the relative trajectory in the plane from the star.
Step 2.2: and establishing a monitoring camera view field constraint.
To ensure initialisation of formation configurationThe FOV geometry of the surveillance camerA consists of two cones, point Ot is the intersection of the vertices of the two cones, representing the optical center of the lens, l is the central axis of the geometry, representing the optical axis, rectangular ABCD is the base of the lower cone, representing the CCD array, and α and β are the FOV angles, α and β are determined by the size of the CCD and the focal length of the lensA non-rotating coordinate system fixed at the optical center of the lens. Therefore, the distance from the point Ot to the centroid of the main star is extremely small, and the distance from Ot to the centroid of the main star is ignored, and therefore, the monitoring coordinate system coincides with the body coordinate system of the main star.
The position vector considering the points is:
the plane OA 'D' may then be expressed as:
where the subscript b denotes the vector described in the body coordinate system. Similarly, the equations for the other three planes are expressed as:
thus, the monitoring constraint is expressed as:
further, assume that the attitude of the primary star is (θ φ ψ) in the orbital coordinate systemT. Where θ, φ and ψ are the pitch, yaw and roll angles, respectively, and then the vectors in the body coordinate system are converted to the orbital coordinate system as shown in equation (40):
wherein L isob(θ, φ, ψ) is a transformation matrix from the body coordinate system to the orbit coordinate system. The formula (40) is substituted for the formula (39) to obtain the monitoring constraint in the orbit coordinate system
Step 2.3: establishing an amplitude constraint for the electric propulsion;
since the electric propulsion is fixed to the slave, the attitude motion of the slave causes the thrust direction to change with respect to the orbital coordinate system, making the configuration initialization significantly more complex, so the configuration initialization is simplified by the attitude of the slave which should be kept constant with respect to the orbital coordinate system, and the thrust acceleration is always along the axis of the orbital coordinate system, so the electric propulsion magnitude constraint is expressed as:
Step three: and establishing a multi-constraint optimal control model for formation based on the true near point angular domain T-H equation analytic solution obtained by derivation in the step one and the monitoring camera view field constraint and thrust amplitude constraint established in the step two.
Step 3.1: establishing a basic optimal control model without considering the constraint condition;
the general form of nonlinear optimal control is expressed as: in the time interval t0,tf]In the method, a state control function for minimizing a performance index functional is found
Simultaneous states are constrained by system dynamics equations
Boundary constraint
Ψ(x(t0),x(tf))=0 (45)
And existing state and path constraints controlling mixing
C(x(t),u(t))≥0 (46)
Wherein E is called a terminal performance index, also called a Mayer type performance index; the integral term containing F is called the process performance indicator, also known as the Lagrange-type performance indicator. Defining an augmented Hamilton function as
L(x(t),u(t),λ,μ)=H(x(t),u(t),λ)+μTC(x(t),u(t)) (47)
Where λ is the co-state variable and H is the Hamilton function
H(x(t),u(t),λ)=λTf(x(t),u(t))+F(x(t),u(t)) (48)
And mu satisfies the complementary condition
μTC(x(t),u(t))=0 (49)
The optimal control and state is obtained by solving the following equations:
where the superscript denotes the optimal solution that satisfies the aforementioned constraints.
Step 3.2: establishing a multi-constraint optimal control model based on the monitoring camera view field constraint and the thrust amplitude constraint established in the step two;
angular velocity and angular acceleration taking into account true paraxial angle
Wherein the content of the first and second substances,representing the average track angular velocity, while a and e represent the semi-major axis and eccentricity of the track, respectively. Then, by substituting equation (52) for equations (5) and (6), the augmented kinetic equation is restated as:
whereinShows augmentation kinetics, andrepresenting the augmented state vector. The expression in said equation (34) is considered as a nonlinear state constraint on the augmented dynamics, enabling the problem to be solved by using a direct method.
Once the formation configuration has started, the slaves are released, the initial state of the configuration being determined by the release position and speed, i.e.
The final state of the formation configuration is constrained by the periodic fly-around:
wherein c isi(i ═ 1, 2.., 6) calculated according to equations (21) to (26), the slave star must be located in the FOV of the master star CCD camera during configuration, i.e. according to equation (41), the relative states should satisfy the following constraints:
the thrust on each shaft should also satisfy the following constraints:
the mathematical description of the multi-constraint optimal control problem is therefore:
equation (58) is subject to the dynamic constraints of equation (53), the initial state constraints of equation (54), the period fly-around constraints of equation (55), the FOV constraints of equation (56), and the thrust magnitude constraints of equation (57).
Step four: and solving the multi-constraint optimal control model to obtain a solution of the original optimal control problem and then obtain a collaborative value at any moment, namely realizing the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition and realizing the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
And step four, the method for solving and establishing the multi-constraint optimal control model of the formation comprises a direct method, an indirect method and a mixed method.
The Gaussian pseudo-spectrum method is a direct method, and is consistent with a first-order necessary condition in an optimal control theory in the solving process; on the other hand, according to the principle of co-state mapping, the gaussian pseudo-spectrum method can obtain co-state information the same as the optimal control theory, therefore, the method for solving and establishing the multi-constraint optimal control model for formation described in the fourth step is preferably a gaussian pseudo-spectrum method for solving, and when the gaussian pseudo-spectrum method is used for solving and establishing the multi-constraint optimal control model for formation, the concrete implementation method of the fourth step comprises the following steps:
step 4.1: solving by a Gaussian pseudo-spectrum method;
the basic thought of the Gaussian pseudospectrum method is to disperse unknown state time history and control time history on a series of Gaussian points, then to respectively construct Lagrange interpolation polynomial by using the dispersed state and control to approximate to the real state and control time history, to convert the dynamic differential equation constraint into a series of algebraic constraints by means of simple mathematical knowledge, to finally convert the optimal control problem into a parameter optimization problem constrained by a series of algebraic constraints, and to solve by using other numerical methods such as a sequential quadratic programming method.
The Gaussian point is zero point of Legendre polynomial and is unevenly distributed in the interval [ -1,1]Therefore, it is necessary to match the real time interval t ∈ [ t ]0,tf]And (3) carrying out conversion:
substitution of t by T as an independent variable after conversion, t0,tfBecomes a system parameter. Accordingly, the original time domain optimal control problem is expressed in the τ domain as:
using the kth legendre-gaussian point and the state at the initial node, derive a lagrange interpolation polynomial with order K + 1:
wherein
Lagrange interpolation can ensure that the approximation at the interpolation node is exactly the same as the actual state, while the values at other points are only approximately equal. Similarly, using control of the Kth Legendre-Gaussian point, the controlled Lagrangian interpolation polynomial is derived as
Wherein
Differentiating the formula (61) in the equation to obtain
Wherein the differential matrix is determined as follows:
wherein K is 1,2, 1, K, and i is 0,1K(τ) Legendre polynomials of order K, i.e.
Substituting the formula (67) into the formula (66), and algebraicizing the kinetic constraint
The terminal value should be obtained by Gauss quadrature method
Wherein ω iskIs a Gaussian weight, calculated as
ωkAnd DkiDetermined only by the number of LG points K and prior to the optimization algorithmAnd (3) off-line calculation and solving, wherein the continuous performance index functional of the formula (60) is obtained by solving by Gaussian integration:
therefore, the initial optimal control problem is transformed into a nonlinear programming problem by the gaussian pseudo-spectrum method, which is described as follows:
solving the nonlinear programming problem to obtain the solution of the original optimal control problem and obtain the covariant value at any moment, namely realizing the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition and realizing the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
Has the advantages that:
the invention discloses an initialization method for formation configuration of an elliptic orbit satellite under multi-constraint conditions, which is characterized in that a true-anomaly angular domain T-H equation analytic solution is obtained through classical orbit dynamics and coordinate transformation by deduction, dynamics constraint is analyzed, periodic fly-around constraint is carried out, and monitoring camera view field constraint and thrust amplitude constraint are established, so that a multi-constraint optimal control model for formation is established and solved through a Gaussian pseudo-spectrum method to obtain a coordination value at any moment, the real-time monitoring on the structural integrity of a spacecraft is realized, and the fuel consumption and the maximum amplitude of a propulsion system are reduced by increasing the eccentricity and the initialization time.
Description of the drawings:
FIG. 1 is a flow chart of an initialization method for formation configuration of elliptic orbit satellites under multiple constraints according to the present invention;
FIG. 2 is a schematic diagram of a coordinate system for a two-star formation according to the present invention;
FIG. 3 is a view of the FOV geometry of step two of the present invention;
FIG. 4 is a schematic view of FOV constraints in step two of the present invention;
FIG. 5 is a release trajectory from the star and a fly-around trajectory of the present invention;
FIG. 6 is a projection of the release trajectory from the star and the orbit around the fly in the x-y plane of the present invention;
FIG. 7 is a projection of the release trajectory from the star and the orbit around the flight in the y-z plane of the present invention;
FIG. 8 is a time history of the relative position of the satellites according to the present invention;
FIG. 9 is a time history of relative velocity from the stars according to the present invention;
FIG. 10 is a time history of the present invention from the star to the optimal thrust acceleration;
Detailed Description
To better illustrate the objects and advantages of the present invention, the following detailed description of the embodiments of the present invention is provided in conjunction with the accompanying drawings. In the whole simulation process, all orbit perturbations are ignored, meanwhile, the orbit attitude of the main satellite is considered to be unchanged in the whole process, the auxiliary satellite is fixed on the main satellite before release, the formation initialization process is started by an ejection device, and then the auxiliary satellite enters a preset relative orbit flying around. And (3) simulating to convert the original optimal control model into a series of nonlinear programming problems (NLPs) by using a GPOPS-II tool box in a Matlab environment, and then finishing final solution by using SNOPT software.
Example 1:
in the method for initializing formation configuration of an elliptic orbit satellite under multiple constraint conditions disclosed by the embodiment, the reference orbit parameters are as follows: the semi-major axis a is 8378km, the inclination angle i is 15 °, the ascension angle Ω is 45 ° and the perigee angular distance ω is 30 °. At the beginning of the control, an initial true paraxial angle f is assumed0The parameter k within the period fly-around constraint is 0.5, and the FOV range of the surveillance camera is 60 ° × 60 °. The secondary satellite is a micro satellite with the mass of 10 kilograms and is provided with a three-dimensional electric propulsion device, and the maximum amplitude of the thrust in each direction is 100 mN. The time taken for release (denoted t)f) Set to 1500 seconds, the orbit eccentricity e is 0.05 from the initial state of the star.
The method comprises the following steps: and deducing to obtain the analytic solution of the true-near-point angular domain T-H equation through classical orbit dynamics and coordinate transformation.
As shown in FIG. 2, a fixed inertial frame centered on the earth is established with the X-axis pointingAt spring equinox, the Z axis is consistent with the rotation axis direction of the earth, and the Y axis is determined according to the right-hand rule. And establishing an orbit coordinate system which takes the main star as a mass center and rotates relative to the origin, wherein the x axis of the orbit coordinate system points to the center of the main star from the center of the earth, the z axis is vertical to the orbit plane, and the y axis is determined according to the right-hand rule. According to classical orbital dynamics, the data such as the semi-major axis a being 8378km, the inclination angle i being 15 °, the ascension point omega being 45 ° and the perigee angular distance omega being 30 ° are substituted into the equations (17) (18) (19) to obtain an analytic solution
Step two: and deducing a periodic fly-around constraint condition, and establishing a monitoring camera view field constraint and a thrust amplitude constraint.
Step 2.1: deriving a periodic fly-around constraint in a true anomaly angle domain;
step 2.2: establishing a monitoring camera view field constraint;
as shown in FIGS. 3 and 4, the FOV geometry of the surveillance camerA is made up of two cones, point Ot is the intersection of the vertices of the two cones, representing the optical center of the lens, l is the central axis of the geometry, representing the optical axis, rectangle ABCD is the bottom of the lower cone, representing the CCD array, and α and β are the FOV angles, α and β are determined by the size of the CCD and the focal length of the lensA non-rotating coordinate system fixed at the optical center of the lens. Therefore, the distance from the point Ot to the centroid of the main star is extremely small, and the distance from Ot to the centroid of the main star is ignored, and therefore, the monitoring coordinate system coincides with the body coordinate system of the main star.
Step 2.3: establishing an amplitude constraint for the electric propulsion;
step three: and establishing a multi-constraint optimal control model for formation based on the true near point angular domain T-H equation analytic solution obtained by derivation in the step one and the monitoring camera view field constraint and thrust amplitude constraint established in the step two.
Step 3.1: establishing a basic optimal control model without considering the constraint condition;
step 3.2: establishing a multi-constraint optimal control model based on the monitoring camera view field constraint and the thrust amplitude constraint established in the step two;
step four: and solving the multi-constraint optimal control model to obtain a solution of the original optimal control problem and then obtain a collaborative value at any moment, namely realizing the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition and realizing the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
Step 4.1: solving by a Gaussian pseudo-spectrum method;
will be true of the angle f0The parameter k within the period fly-around constraint is 0.5, and the FOV range of the surveillance camera is 60 ° × 60 °. The secondary satellite is a micro satellite with the mass of 10 kilograms and is provided with a three-dimensional electric propulsion device, and the maximum amplitude of the thrust in each direction is 100 mN. The time taken for release (denoted t)f) The initial state of the star is set to 1500 seconds, and constraint conditions such as the orbital eccentricity e being 0.05 are substituted into yes (72), and the optimal solution J being 0.0067 is obtained. Fig. 5 shows the configuration and periodic fly-around trajectory of the slave star in the orbital coordinate system, with the quadrangular pyramid in fig. 5 representing the FOV of the camera.
Fig. 4 shows that the optimal release trajectory is always within the quadrangular pyramid until the slave stars enter the periodic orbit around, which enables real-time monitoring of the slave stars to ensure the safety of the formation configuration, and the trajectory is also smooth, with no oscillations observed during release. After 1500 seconds of release has expired, the slave star moves continuously by following the desired periodic fly-around trajectory, which also demonstrates the correctness of the constraint in equation (55) when the periodic fly-around relative motion in the elliptical orbit is initialized.
FIGS. 6 and 7 show the projection of the trajectory in the x-y and z-y planes: since the eccentricity of the reference track is small, the closed projections in the two planes approximate an ellipse, which is consistent with the conclusion drawn by equation (33). The time history from the relative position and velocity of the star is shown in figures 8 and 9, respectively, and during release the relative position and velocity smoothly change from an initial value to a desired final value with peak values of relative velocity of 0.85m/s (x direction), 1.5m/s (negative y direction) and 0.47m/s (z direction), respectively.
As shown in fig. 10, the optimum thrust acceleration also smoothly changes from a positive value to a negative value throughout the release process, and the maximum magnitude of the thrust acceleration occurs on the x-axis of 1500s, but the thrust acceleration does not exceed 30% of the maximum magnitude in any of the three directions.
In summary, the above description is only a preferred embodiment of the present invention, and is not intended to limit the scope of the present invention. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (3)
1. An initialization method for formation configuration of elliptic orbit satellites under multiple constraint conditions is characterized by comprising the following steps: comprises the following steps of (a) carrying out,
the method comprises the following steps: deducing to obtain an analytic solution of a true-near-point angular domain T-H equation through classical orbit dynamics and coordinate transformation;
step two: deducing a periodic fly-around constraint condition, and establishing a monitoring camera view field constraint and a thrust amplitude constraint;
step three: establishing a multi-constraint optimal control model for formation based on the true near point angular domain T-H equation analytic solution obtained by derivation in the first step and the monitoring camera view field constraint and thrust amplitude constraint established in the second step;
step four: solving the multi-constraint optimal control model to obtain a solution of an original optimal control problem and then obtain a collaborative value at any moment, namely realizing the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition, and realizing the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite;
the specific implementation method of the step one is that,
step 1.1: respectively establishing an inertia coordinate system and a track coordinate system;
establishing a fixed inertial coordinate system with the earth as a center, wherein an X axis points to spring equinox, a Z axis is consistent with the direction of a rotating shaft of the earth, and a Y axis is determined according to a right-hand rule; establishing an orbit coordinate system which takes the main satellite as a mass center and rotates relative to an origin, wherein the x axis of the orbit coordinate system points to the center of the main satellite from the center of the earth, the z axis is vertical to an orbit plane, and the y axis is determined according to a right-hand rule;
step 1.2: obtaining an analytic solution according to classical orbit dynamics;
defining the relative position vector rho ═ r of the master star and the slave stard-rcWherein r isd∈R3And rc∈R3Position vectors of the slave star and the master star, respectively; the relative dynamics between the master and slave stars are expressed in the inertial reference frame as:
where μ represents a constant earth gravity coefficient and u ∈ R3Representing the actively controlled acceleration generated by a propeller fixed to the tracker; from the inertial reference system to the orbital coordinate system, equation (1) is approximately expressed as:
where ω is the orbital angular velocity of the primary satellite and the subscript o denotes the vector described in the rotating orbital coordinate system; substituting formula (1) into formula (2), the relative motion is expressed as
Wherein
Wherein f is the true proximal angle of the principal star; finally, substituting equations (1) and (2) into equation (3) yields:
wherein
Neglecting active control, equations (5) to (7) are T-H equations; the T-H equation describes the relative dynamics of free flight orbits of the two spacecrafts, and the internal and external motion of the orbital plane is decoupled; due to the nonlinearity of the T-H equation, an analytic solution of the T-H equation is difficult to find in a time domain; therefore, the T-H equation is rewritten by the following transformation:
taking the first and second derivatives of f,
the following operators are defined:
finally, substituting equations (9) to (13) into equations (5) to (7), the relative kinetics are re-expressed as:
obviously, the equations (14) - (15) are linearized and solved under the given initial conditions:
wherein
h and p are the angular momentum of the main star and the positive semi-focal distance respectively; c. Ci(i ═ 1, 2.., 6) is a constant coefficient determined by the initial state of the main star and the initial true proxel angle, calculated as:
analytic solution of T-H equation intoNamely, deducing to obtain an analytic solution of a true near point angular domain T-H equation;
the concrete implementation method of the second step is that,
step 2.1: deriving a periodic fly-around constraint in a true anomaly angle domain;
since the expressions (21) to (26) are all sinusoidal, for a given true paraxial angle f, c4(f) Is equal to 0, i.e
Periodic relative trajectories can be ensured; further, the following formulae (9), (10) and (27):
equation (28) is a prerequisite for a periodic trajectory in an arbitrary elliptical orbit, and if equation (27) is satisfied, the corresponding periodic relative motion is expressed as
However, since equation (27) cannot guarantee a periodic fly-around trajectory, equation (30) is rewritten as follows:
then, combining the formula (32) and the formula (29), the in-plane relative trajectory is represented as
When the in-plane track flies around, the three-dimensional track can be ensured to fly around; in formula (33), when c1When the orbit is 0, the orbit is reduced to an ellipse with (0,0) as the center, and the half axis of the ellipse changes with time; the periodic fly-around constraint is described as:
where k is a coefficient selected according to the orbit around, k may be set to zero if it is desired to follow the relative trajectory in the plane from the star;
step 2.2: establishing a monitoring camera view field constraint;
to ensure the safety of the initialization of the formation configuration, the master satellite is equipped with a visible camera to monitor the release process of the slave satellite, the slave satellite is located in the field of view of the camera until the slave satellite forms a periodic orbit around the fly, the FOV geometry of the surveillance camera is composed of two cones, the point Ot is the intersection of the vertices of the two cones, which represents the optical center of the lens, l is the central axis of the geometry, which represents the optical axis, the rectangle ABCD is the bottom of the lower cone, which represents the CCD array, and α and β are the FOV angles, the FOV angles α and β are determined by the size of the CCD and the focal length of the lens, the range of the FOV is determined by the size ofThe cone O-A 'B' C 'D' represents, but has an infinite depth; the extent of the field of view is represented by a cone, also with infinite depth, and the surveillance coordinate system is represented asA non-rotating coordinate system fixed on the optical center of the lens; therefore, the distance from the point Ot to the centroid of the primary star is extremely small, and the distance from Ot to the centroid of the primary star is ignored, so that the monitoring coordinate system is consistent with the body coordinate system of the primary star;
the position vector considering the points is:
the plane OA 'D' may then be expressed as:
wherein the subscript b denotes a vector described in the body coordinate system; the equations for the other three planes are expressed as:
thus, the monitoring constraint is expressed as:
further, assume that the attitude of the primary star is (θ φ ψ) in the orbital coordinate systemT(ii) a Where θ, φ and ψ are the pitch, yaw and roll angles, respectively, and then the vectors in the body coordinate system are converted to the orbital coordinate system as shown in equation (40):
wherein L isob(θ, φ, ψ) is a transformation matrix from the body coordinate system to the orbit coordinate system; the formula (40) is substituted for the formula (39) to obtain the monitoring constraint in the orbit coordinate system
Step 2.3: establishing an amplitude constraint for the electric propulsion;
configuration initialization is simplified by keeping the attitude of the satellites constant relative to the orbital coordinate system, and thrust acceleration is always along the axis of the orbital coordinate system, so the electric propulsion magnitude constraint is expressed as:
the third step is realized by the concrete method that,
step 3.1: establishing a basic optimal control model without considering the constraint condition;
the general form of nonlinear optimal control is expressed as: in the time interval t0,tf]In the method, a state control function for minimizing a performance index functional is found
Simultaneous states are constrained by system dynamics equations
Boundary constraint
Ψ(x(t0),x(tf))=0 (45)
And existing state and path constraints controlling mixing
C(x(t),u(t))≥0 (46)
Wherein E is called a terminal performance index, also called a Mayer type performance index; the integral term containing F is called a process performance index, also called a Lagrange-type performance index; defining an augmented Hamilton function as
L(x(t),u(t),λ,μ)=H(x(t),u(t),λ)+μTC(x(t),u(t)) (47)
Where λ is the co-state variable and H is the Hami1ton function
H(x(t),u(t),λ)=λTf(x(t),u(t))+F(x(t),u(t)) (48)
And mu satisfies the complementary condition
μTC(x(t),u(t))=0 (49)
The optimal control and state is obtained by solving the following equations:
wherein superscript denotes an optimal solution satisfying the aforementioned constraint condition;
step 3.2: establishing a multi-constraint optimal control model based on the monitoring camera view field constraint and the thrust amplitude constraint established in the step two;
angular velocity and angular acceleration taking into account true paraxial angle
Wherein the content of the first and second substances,represents the average track angular velocity, while a and e represent the semi-major axis and eccentricity of the track, respectively; then, by substituting equation (52) for equations (5) and (6), the augmented kinetic equation is restated as:
whereinShows augmentation kinetics, andrepresents an augmented state vector; the expression in said formula (34) is considered as a nonlinear state constraint on the augmented dynamics, enabling the problem to be solved by using a direct method;
once the formation configuration has started, the slaves are released, the initial state of the configuration being determined by the release position and speed, i.e.
The final state of the formation configuration is constrained by the periodic fly-around:
wherein c isi(i ═ 1, 2.., 6) calculated according to equations (21) to (26), the slave star must be located in the FOV of the master star CCD camera during configuration, i.e. according to equation (41), the relative states should satisfy the following constraints:
the thrust on each shaft should also satisfy the following constraints:
the mathematical description of the multi-constraint optimal control problem is therefore:
equation (58) is subject to the dynamic constraints of equation (53), the initial state constraints of equation (54), the period fly-around constraints of equation (55), the FOV constraints of equation (56), and the thrust magnitude constraints of equation (57).
2. The method for initializing formation configuration of elliptic orbit satellites under multiple constraints as claimed in claim 1, wherein: and step four, the method for solving and establishing the multi-constraint optimal control model of the formation comprises a direct method, an indirect method and a mixed method.
3. The method for initializing formation configuration of elliptic orbit satellites under multiple constraints as claimed in claim 1, wherein: the Gaussian pseudo-spectral method is a direct method, when the Gaussian pseudo-spectral method is used for solving and establishing the multi-constraint optimal control model of formation, the concrete implementation method of the step four comprises the following steps,
step 4.1: solving by a Gaussian pseudo-spectrum method;
the basic thought of the Gaussian pseudospectrum method is that unknown state time history and control time history are dispersed on a series of Gaussian points, Lagrange interpolation polynomial is respectively constructed by using the dispersed state and control to approximate to real state and control time history, the constraint of a kinetic differential equation is converted into a series of algebraic constraints, the optimal control problem is finally converted into a parameter optimization problem constrained by the series of algebraic constraints, and other numerical methods such as a sequence quadratic programming method are utilized to solve the problem;
the Gaussian point is zero point of Legendre polynomial and is unevenly distributed in the interval [ -1,1]Therefore, it is necessary to match the real time interval t ∈ [ t ]0,tf]And (3) carrying out conversion:
substitution of t by T as an independent variable after conversion, t0,tfBecoming system parameters; accordingly, the original time domain optimal control problem is expressed in the τ domain as:
using the kth legendre-gaussian point and the state at the initial node, derive a lagrange interpolation polynomial with order K + 1:
wherein
Lagrange interpolation can ensure that the approximation at the interpolated node is exactly the same as the actual state, while the values at other points are only approximately equal; using the control of the Kth Legendre-Gaussian point, the controlled Lagrange interpolation polynomial is derived as
Wherein
Differentiating the formula (61) in the equation to obtain
Wherein the differential matrix is determined as follows:
wherein K is 1,2, 1, K, and i is 0,1K(τ) Legendre polynomials of order K, i.e.
Substituting the formula (67) into the formula (66), and algebraicizing the kinetic constraint
The terminal value should be obtained by Gauss quadrature method
Wherein ω iskIs a Gaussian weight, calculated as
ωkAnd DkiDetermined only by the number of LG points K and solved off-line prior to the optimization algorithm, the continuous performance indicator functional of equation (60) is solved by gaussian integration:
therefore, by the gaussian pseudo-spectrum method, the initial optimal control problem is transformed into a nonlinear programming problem, which is described as follows:
solving the nonlinear programming problem to obtain the solution of the original optimal control problem and obtain the covariant value at any moment, namely realizing the initialization of the formation configuration of the elliptic orbit satellite under the multi-constraint condition and realizing the effective optimal control under the multi-constraint condition through the initialization of the formation configuration of the satellite.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811492401.8A CN109375648B (en) | 2018-12-07 | 2018-12-07 | Elliptical orbit satellite formation configuration initialization method under multi-constraint condition |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811492401.8A CN109375648B (en) | 2018-12-07 | 2018-12-07 | Elliptical orbit satellite formation configuration initialization method under multi-constraint condition |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109375648A CN109375648A (en) | 2019-02-22 |
CN109375648B true CN109375648B (en) | 2020-04-10 |
Family
ID=65376080
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811492401.8A Active CN109375648B (en) | 2018-12-07 | 2018-12-07 | Elliptical orbit satellite formation configuration initialization method under multi-constraint condition |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109375648B (en) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110209053A (en) * | 2019-06-10 | 2019-09-06 | 西北工业大学深圳研究院 | The controller design method and control method of cluster satellite system |
CN111552293B (en) * | 2020-05-13 | 2021-01-15 | 湖南大学 | Mobile robot formation control method based on images under visual field constraint |
CN112329134B (en) * | 2020-10-22 | 2022-07-08 | 上海卫星工程研究所 | Double-star InSAR formation configuration optimization method and system based on engineering constraints |
CN112927142B (en) * | 2021-04-02 | 2022-11-11 | 中国人民解放军国防科技大学 | High-speed high-resolution video generation method and device based on time domain interpolation |
CN113296535B (en) * | 2021-05-24 | 2022-06-21 | 四川大学 | Satellite formation reconstruction algorithm based on stochastic model predictive control |
CN113297672B (en) * | 2021-05-27 | 2022-09-02 | 中国人民解放军63921部队 | Satellite orbiting aircraft motion parameter determination method based on orbit error analysis |
CN113721650B (en) * | 2021-07-20 | 2024-02-02 | 西北工业大学 | Space 4N satellite square formation design method, system, equipment and storage medium |
CN113885570B (en) * | 2021-10-25 | 2023-11-21 | 天津大学 | Satellite formation reconstruction control method based on rotation potential field |
CN114253291B (en) * | 2021-12-15 | 2023-11-14 | 北京航空航天大学 | Spacecraft formation guidance method and system based on linear pseudo spectrum model predictive control |
CN114979477B (en) * | 2022-05-18 | 2023-05-26 | 中国西安卫星测控中心 | Follow-up observation task planning method and device for space surveillance camera |
CN115072006B (en) * | 2022-07-06 | 2023-04-21 | 上海交通大学 | Dual-mode track reconstruction control method and system based on active utilization of spatial perturbation |
CN115535304B (en) * | 2022-10-09 | 2023-04-25 | 哈尔滨工业大学 | Orbit design and control method for periodic revisit of multiple formation satellites |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0978957A1 (en) * | 1998-08-06 | 2000-02-09 | Alcatel | Method for allocating links between a set of zones and a set of satellites |
US6418312B1 (en) * | 1999-08-30 | 2002-07-09 | Motorola, Inc. | Management of perferred communications periods in a satellite communication system |
CN103412573A (en) * | 2013-07-22 | 2013-11-27 | 西北工业大学 | Elliptical orbit spacecraft relative position regressing control method based on cascade connection equation |
CN104252548A (en) * | 2013-06-27 | 2014-12-31 | 上海新跃仪表厂 | Method of designing injection target point of Mars probe with optimal fuel |
CN107391813A (en) * | 2017-07-03 | 2017-11-24 | 北京航空航天大学 | A kind of energetic optimum moon based on the moon high ladder ground transfer orbit design method |
CN107526368A (en) * | 2017-09-12 | 2017-12-29 | 北京理工大学 | A kind of multiple-pulse ring moon satellites formation initial method for considering error |
CN107589756A (en) * | 2017-09-12 | 2018-01-16 | 北京理工大学 | A kind of Benyue satellites formation initial method |
CN108438255A (en) * | 2018-03-14 | 2018-08-24 | 上海航天控制技术研究所 | Satellite is diversion Formation Configuration initial method under a kind of engineering constraints |
CN108875174A (en) * | 2018-06-06 | 2018-11-23 | 北京航空航天大学 | A kind of constant quasi-periodic orbit based on multistage shooting method determines method |
-
2018
- 2018-12-07 CN CN201811492401.8A patent/CN109375648B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0978957A1 (en) * | 1998-08-06 | 2000-02-09 | Alcatel | Method for allocating links between a set of zones and a set of satellites |
US6418312B1 (en) * | 1999-08-30 | 2002-07-09 | Motorola, Inc. | Management of perferred communications periods in a satellite communication system |
CN104252548A (en) * | 2013-06-27 | 2014-12-31 | 上海新跃仪表厂 | Method of designing injection target point of Mars probe with optimal fuel |
CN103412573A (en) * | 2013-07-22 | 2013-11-27 | 西北工业大学 | Elliptical orbit spacecraft relative position regressing control method based on cascade connection equation |
CN107391813A (en) * | 2017-07-03 | 2017-11-24 | 北京航空航天大学 | A kind of energetic optimum moon based on the moon high ladder ground transfer orbit design method |
CN107526368A (en) * | 2017-09-12 | 2017-12-29 | 北京理工大学 | A kind of multiple-pulse ring moon satellites formation initial method for considering error |
CN107589756A (en) * | 2017-09-12 | 2018-01-16 | 北京理工大学 | A kind of Benyue satellites formation initial method |
CN108438255A (en) * | 2018-03-14 | 2018-08-24 | 上海航天控制技术研究所 | Satellite is diversion Formation Configuration initial method under a kind of engineering constraints |
CN108875174A (en) * | 2018-06-06 | 2018-11-23 | 北京航空航天大学 | A kind of constant quasi-periodic orbit based on multistage shooting method determines method |
Non-Patent Citations (4)
Title |
---|
Relative Dynamics and Control of Spacecraft Formations in Eccentric Orbits;Gokhan Inalhan;《JOURNAL OF GUIDANCE, CONTROL, AND DYNAMICS_2002》;20020228;第25卷(第1期);第48-59页 * |
Relative Motion Between Elliptic Orbits: Generalized Boundedness Conditions and Optimal Formationkeeping;Pini Gurfil;《JOURNAL OF GUIDANCE, CONTROL, AND DYNAMICS_2005》;20050831;第28卷(第4期);第761-767页 * |
日地Halo轨道的多约束转移轨道分层微分修正设计;张景瑞;《宇航学报》;20151031;第36卷(第10期);第1114-1124页 * |
椭圆轨道目标的绕飞初始化问题研究;王炳程;《中国优秀硕士学位论文全文数据库-工程科技Ⅱ辑》;20150215(第2期);第C031-541页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109375648A (en) | 2019-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109375648B (en) | Elliptical orbit satellite formation configuration initialization method under multi-constraint condition | |
Chen et al. | On-orbit assembly of a team of flexible spacecraft using potential field based method | |
Sun et al. | Neural network-based sliding mode control for atmospheric-actuated spacecraft formation using switching strategy | |
CN109911249B (en) | Interstellar transfer limited thrust orbit-entering iterative guidance method for low thrust-weight ratio aircraft | |
Gao et al. | Free-flying dynamics and control of an astronaut assistant robot based on fuzzy sliding mode algorithm | |
CN113341731A (en) | Space robot trajectory planning method based on sequence convex optimization | |
US10202208B1 (en) | High control authority variable speed control moment gyroscopes | |
Zhu et al. | Rotating object specific tracking based on orbit-attitude coordinated adaptive control | |
Wang et al. | Artificial potential function based spacecraft proximity maneuver 6-DOF control under multiple pyramid-type constraints | |
Li et al. | Dynamics and control for contactless interaction between spacecraft and tumbling debris | |
CN111026154A (en) | Six-degree-of-freedom cooperative control method for preventing collision in spacecraft formation | |
Bennett et al. | Touchless electrostatic detumble of a representative box-and-panel spacecraft configuration | |
Guerman et al. | Closed relative trajectories for formation flying with single-input control | |
Singh et al. | Nonlinear adaptive spacecraft attitude control using solar radiation pressure | |
Rughani et al. | Swarm rpo and docking simulation on a 3dof air bearing platform | |
Zhang et al. | Coupled Dynamics and Integrated Control for position and attitude motions of spacecraft: a survey | |
Zhao et al. | Multiple spacecraft formation flying control around artificial equilibrium point using propellantless approach | |
Wan et al. | Six-dimensional atmosphere entry guidance based on dual quaternion | |
Ortega | Fuzzy logic techniques for rendezvous and docking of two geostationary satellites | |
Xu et al. | Coordinated control method of space-tethered robot system for tracking optimal trajectory | |
Huang et al. | Nonlinear Robust $ H_ {\infty} $ Control for Spacecraft Body-Fixed Hovering Around Noncooperative Target Via Modified $\theta-D $ Method | |
Natarjan | A study of dynamics and stability of two-craft Coulomb tether formations | |
CN108614578B (en) | Spacecraft formation flying method on low-thrust suspension orbit | |
Zeng et al. | Feasibility analysis of the angular momentum reversal trajectory via hodograph method for high performance solar sails | |
Qi et al. | Displaced electric sail orbits design and transition trajectory optimization |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |