A method for attitude-orbit coupling control of distributed spacecraft formation with preset time

Through the preset time distributed spacecraft formation attitude and orbit coupling control method, the problem of neglecting the attitude and position coupling relationship of spacecraft in traditional technology is solved, and high-precision spacecraft formation control is realized within the preset time to meet complex space missions The accuracy and response speed requirements show the application prospects in complex environments.

CN115167523BActive Publication Date: 2024-11-22UNIV OF ELECTRONICS SCI & TECH OF CHINA
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202210971663.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-08-12
Publication Date
2024-11-22
Estimated Expiration
2042-08-12

AI Technical Summary

Technical Problem

Traditional spacecraft formation flight technology ignores the coupling relationship between spacecraft attitude and position, resulting in increased posture control difficulty and controller design complexity, and existing spacecraft formation attitude orbit coupling technology fails to effectively consider convergence time and Convergence accuracy cannot meet the requirements of precision and response speed for complex aerospace missions.

Method used

By using the preset time distributed spacecraft formation attitude orbit coupling control method, the spacecraft attitude orbit coupling dynamic model is established, the preset time function is constructed, the preset formation performance inequality is designed, and the preset time formation control protocol is designed to realize High-precision spacecraft formation control within preset time.

Benefits of technology

Achieving control accuracy of 10^-6 or above under the order of 10^-3 interference avoids controller tremor, meets user's transient and steady-state performance requirements, and has low computational complexity and robustness. Implement spacecraft formation missions within the preset time.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115167523B_ABST
    Figure CN115167523B_ABST
Patent Text Reader

Abstract

The present invention discloses a preset time distributed spacecraft formation attitude-orbit coupling control method, which is applied to the field of satellite cluster and spacecraft formation intelligent control, and aims at the problem that the prior art lacks a solution for high-precision spacecraft formation with preset time in certain emergency situations; the present invention first establishes a spacecraft attitude-orbit coupling dynamics model; secondly, designs a preset time function to specify the formation convergence time of the spacecraft; then designs a preset formation performance inequality to combine the spacecraft formation error with the preset time function to describe the convergence time of the spacecraft formation tracking error; finally, designs a preset time formation control protocol to realize the preset time spacecraft formation. The control method of the present invention enables spacecraft to realize formation within the time set by the user, does not require information such as the moment of inertia and mass of the spacecraft, and has low calculation complexity and high control accuracy of the controller, and is suitable for application in the attitude-orbit coupling tracking control problem of spacecraft formation flight.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the field of satellite cluster and spacecraft formation intelligent control, and in particular relates to a spacecraft formation attitude-orbit coupling control technology. Background Art

[0002] In recent years, with the rapid development of aerospace technology, aerospace missions have become increasingly complex. Spacecraft formation flying has attracted the attention of aerospace departments and scientific researchers around the world with its advantages of flexible deployment, fast mission response, high reliability, and good reconfigurability. Compared with traditional single independent satellite systems, satellite formations have been significantly improved in reliability, mission diversity, functional scalability, production cycle, system cost, etc., and are an important direction for the development of future satellite technology. Traditional spacecraft formation flying technology either considers the spacecraft formation configuration control technology alone or the spacecraft formation attitude cooperative control technology alone, ignoring the coupling relationship between spacecraft attitude and position, which obviously increases the difficulty of spacecraft attitude control and the complexity of controller design, and reduces the control accuracy of spacecraft formation attitude and orbit. Some aerospace missions, such as three-dimensional stereo imaging, deep space exploration, synthetic aperture radar systems, etc., put forward higher requirements on the control accuracy and convergence speed of the relative position and attitude of formation spacecraft. In addition, system stabilization time and convergence error are two particularly important performance indicators for the control system. The shorter the system stabilization time, the faster the control system responds, and the smaller the convergence error, the higher the convergence accuracy of the control system. Existing spacecraft formation attitude-orbit coupling technologies mostly focus on the formation stability problem, and rarely consider the convergence time and convergence accuracy. As the requirements of space missions become more and more complex, the convergence time and convergence error of spacecraft formations have received more and more attention. Therefore, the spacecraft formation attitude-orbit coupling control problem with preset time and convergence error is a challenging and worthy problem to study. Summary of the invention

[0003] In order to solve the above technical problems, the present invention proposes a preset time distributed spacecraft formation attitude and orbit coupling control method, which is used to realize spacecraft formation within a preset time and achieve control with an accuracy of more than 10^-6 under interference of the order of 10^-3.

[0004] The technical solution adopted by the present invention is: a method for attitude-orbit coupling control of a distributed spacecraft formation with a preset time, comprising:

[0005] S1. Establish the attitude-orbit coupling dynamics model of the spacecraft;

[0006] S2. Constructing a preset time function to specify the formation convergence time of the spacecraft;

[0007] S3. designing a preset formation performance inequality according to the constructed preset time function;

[0008] S4. Design a preset time formation control protocol based on the spacecraft attitude-orbit coupling dynamics model and the preset formation performance inequality, so as to realize the preset time spacecraft formation.

[0009] Beneficial effects of the present invention: In view of the fact that there are relatively few inventions related to attitude-orbit coupling control of spacecraft formations, but as aerospace needs become more and more complex, the influence of attitude-orbit coupling needs to be considered when designing formation algorithms, so the present invention is aimed at the problem of spacecraft formation considering the influence of attitude-orbit coupling. In addition, convergence time and convergence accuracy are another challenging problem that needs to be considered for spacecraft formations, which are very important for certain aerospace missions, so the present invention solves the problem of preset time spacecraft formations in combination with preset performance control methods, and the present invention makes the convergence error of spacecraft formations less than the order of 10^-6. Therefore, the present invention shows broad application prospects in the field of fast and high-precision control of spacecraft formations. Compared with the prior art, the present invention has the following advantages:

[0010] 1. The designed controller can enable the spacecraft to achieve the formation task within the set time, without the need for information such as the spacecraft's moment of inertia and mass. Compared with the existing finite time controller, the controller of the present invention will not have a tremor phenomenon and can make the spacecraft formation control system response process meet the transient and steady-state performance set by the user;

[0011] 2. The designed controller has low computational complexity, certain robustness and high control accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0012] Figure 1 Design steps for pre-setting the time for distributed spacecraft formation control scheme;

[0013] Figure 2 Communication topology for formation spacecraft;

[0014] Figure 3 is the formation error time response value of the preset performance under the action of the controller of the present invention;

[0015] Figure 4 is the convergence accuracy of the formation error under the action of the controller of the present invention;

[0016] Figure 5 is the motion trajectory of the formation spacecraft in the LVLH system. DETAILED DESCRIPTION

[0017] To facilitate those skilled in the art to understand the technical content of the present invention, the present invention is further explained below with reference to the accompanying drawings.

[0018] like Figure 1 As shown, a spacecraft formation attitude-orbit coupling control method with a preset time of the present invention, combined with a specific implementation, includes the following steps:

[0019] S1. Establishing the attitude-orbit coupling model of the spacecraft includes the following steps:

[0020] S11. For the four spacecraft in the formation, the modified Rodrigues parameters (MRPs) are used to describe the spacecraft attitude, and the attitude dynamics model of spacecraft i in the Euler-Lagrangian form is established as follows:

[0021]

[0022] σ i =[σ i,1 ,σ i,2 ,σ i,3 ] T ∈R 3 represents the attitude of the i-th spacecraft system relative to the Earth Centered Inertial Frame (ECI), σ i,1 ,σ i,2 ,σ i,3 They represent the projection values ​​of the posture on the three axes of the ECI system respectively; Represents σ i The derivative with respect to time; w i =[w i,1 ,w i,2 ,w i,3 ] T ∈R 3 represents the projection of the angular velocity of the spacecraft system relative to the ECI system in the system, R represents the real number set, R 3 represents a three-dimensional vector space composed of real numbers, w i,1 ,w i,2 ,w i,3 It represents the projection value of angular velocity on the three axes of the ECI system; Indicates w i The derivative with respect to time; J i ∈R 3 represents the moment of inertia of the i-th spacecraft. S(a) represents the cross product matrix, as shown in formula (2); τ i ,τ di ∈R 3 It represents the projection of the control torque and external disturbance torque acting on the i-th spacecraft in the spacecraft body system. The spacecraft body system is a fixed coordinate system that moves with the satellite, also known as the satellite body coordinate system. The origin of the coordinate is located at the center of mass of the satellite, and the three coordinate axes form a right-handed coordinate system along the three characteristic axes of the satellite.

[0023]

[0024] G(σ i ) is expressed as

[0025]

[0026] Where T in the superscript represents matrix transpose, and I3 represents the 3×3 identity matrix. Formula (1) can be rewritten in Euler-Lagrange form:

[0027]

[0028]

[0029] The initial posture σ of each spacecraft in the formation of this embodiment i (0) and the initial angular velocity w i Select as:

[0030] σ1(0)=[0;0;0],σ2(0)=[0.05;0.1;0.02],σ3(0)=[0.03;0.01;0.04],σ4(0)=[0.3;0.01;0.015]

[0031] w1(0)=[0;0;0], w2(0)=[0;0;0], w3(0)=[0;0;0], w4(0)=[0;0;0]

[0032] The moment of inertia of each spacecraft is selected as:

[0033]

[0034] S12, using CW equations to describe the relative orbital dynamics model of spacecraft i;

[0035] Assuming that the constellation runs on a circular orbit, the relative dynamic equation of the ith satellite relative to the constellation reference point is:

[0036]

[0037]

[0038]

[0039] Where m i represents the mass of the i-th spacecraft, ρ i ∈R 3 represents the position of the i-th spacecraft relative to the reference point, Respectively represent ρ i The first and second derivatives of represents the angular velocity of the reference point rotating around the earth, fbi ,F di ∈R 3 They represent the projection and interference force of the control force of the i-th spacecraft in this system. lbi =R le R ebi ∈R 3×3 represents the rotation matrix of the local coordinate system (Local-Vertical-Local-Horizontal Frame LVLH system) of the i-th spacecraft to the reference point, where R le ,R ebi ∈R 3×3 denote the rotation matrix from the ECI system to the LVLH system of the reference point and the rotation matrix from the i-th spacecraft system to the ECI system, where R le It can be calculated by the position and velocity of the reference point. And R bei It can be expressed as:

[0040]

[0041] In this embodiment, the mass of each spacecraft is selected as m i =50kg,i=1,2,3,4, R c =6678140, the initial position and speed are selected as:

[0042]

[0043] S13, combining the spacecraft attitude dynamics model and the relative orbit dynamics model to establish an attitude-orbit coupled dynamics model of spacecraft i with normalized position;

[0044] In order to facilitate the design of the preset performance controller, the position is normalized so that the position and attitude of the spacecraft are in the same order of magnitude. Let the state quantity be in ρ max Represents the maximum distance between all spacecraft and the reference point. In this embodiment, ρ max = 3000 m. Combining equations (5) and (6) yields the attitude-orbit coupling model of the ith spacecraft in the Euler-Lagrangian form:

[0045]

[0046] in

[0047]

[0048]

[0049]

[0050] S2. The preset time function is designed as follows;

[0051]

[0052] p0,p ∞ They represent the initial value and steady-state value of the preset time function respectively, T represents the preset system stabilization time, which can be used to limit the system response speed; p ∞ It can be used to limit the convergence error of the system. In this embodiment, p0=1, p ∞ =10 -5 ,T=85s.

[0053] S3. Design the preset formation performance inequality as follows:

[0054] -v 1i,m p(t) <e i,m (t) <v 2i,m p(t),m=1,2,…,6 (10)

[0055] Among them, the value of m is related to the specific dimension. According to formula (11), we can know that e i ∈R 6 For six-dimensional data, m = 1, 2, ..., 6, e i,m Indicates e i The element in the mth column, that is, e i =[e i,1 ,…,e i,6 ] T , similarly, v 1i,m and v 2i,m Respectively represent v 1i and v 2i The mth element of e i represents the formation error of spacecraft i and is defined as:

[0056]

[0057] in represents the expected state of the i-th spacecraft (where the expected position is the normalized value). In this embodiment, Selected as:

[0058]

[0059] In formula (10), v 1i ,v 2i Designed to

[0060]

[0061] Formula (10) is used to limit the convergence time and convergence error of the spacecraft formation error. For the mth element of the formation error, if Formula (10) is satisfied in the entire time domain, then e i,m will be contained in the function envelope consisting of (-rp(t), p(t)) or (-p(t), rp(t)), then e i,m Finally, it will converge to the preset convergence area within the preset time T (-rp ∞ ,p ∞ ) or (-p ∞ ,rp ∞ )Inside.

[0062] Select r = 1. In formula (11) represents the neighbors of spacecraft i, a ij represents the communication relationship between spacecraft, a ij = 1 indicates that there is information exchange between agent i and agent j. The communication relationship between the spacecraft in the formation can be represented by the adjacency matrix, written as A = [a ij ],i,j=1,…,n, the communication topology of the four spacecraft in this example is as follows Figure 2 As shown, its adjacency matrix can be written as:

[0063]

[0064] S4. Designing a preset time formation control protocol for spacecraft i; specifically comprising the following steps:

[0065] S41. The inequality defined in equation (10) is transformed into an equality constraint through error transformation:

[0066] Define the error transformation function:

[0067] e i,m (t) = p(t)f(ε i,m ) (13)

[0068] make Then f(ε i,m ) can be written as

[0069]

[0070] Take f -1 (g) is in logarithmic function form:

[0071]

[0072] At this point, the inequality constraint becomes the variable ε i,m Bounded constraints, ε i,mBy integrating the preset system stable time information and formation error information, as long as it is always bounded, the inequality constraint defined by formula (10) will hold in the entire time domain, and the formation error of spacecraft i will converge to the preset steady-state region within the preset time. Then, the formation errors of all spacecraft can converge to the preset steady-state region within the preset time, thus realizing the preset time formation.

[0073] S42. Design the preset time formation control protocol of spacecraft i as follows:

[0074]

[0075] Among them, k 1i ,k 2i is a constant greater than 0, ε i =[ε i,1 ,…,ε i,6 ] T ∈R 6 , for e i The derivative of i It is defined in equation (7) here for attitude and orbit decoupling. By calculating the control quantity of each spacecraft in the formation through the above equation and acting on the actuator of the spacecraft, ε can be i,m If it is bounded in the entire time domain, then spacecraft formation can be achieved within the preset time.

[0076] Select k 1i =11,k 2i = 2000, i = 1, 2, 3, 4. Assume that the maximum control force of the spacecraft in the formation is 20N, the maximum control torque is 0.05Nm, and the disturbance force F on each spacecraft is di and the disturbance torque τ di for:

[0077]

[0078]

[0079] Input the result of equation (16) into the actuator of the spacecraft, and the simulation results are as follows: Figure 3-Figure 5 shown.

[0080] Figure 3 The time response values ​​of the formation errors of all spacecraft are shown. It can be seen from the figure that the controller designed by the present invention can make the formation errors of all spacecraft converge to near 0 within 85s (preset time), and its transient value is included in the preset performance envelope and the steady-state value is much less than 10 -5 (Preset steady-state error). Figure 3The prescribed performancebound in indicates the preset performance envelope.

[0081] The spacecraft formation error e under the controller of the present invention i The enlarged image from 90s to 600s is as follows Figure 4 As shown, it shows the formation error e after the spacecraft formation converges (T>85s). i The steady-state response curves of the first three channels (attitude coordination error) and the last three channels (orbit coordination error) show that the steady-state value of the attitude coordination error of the spacecraft formation is less than 10 -8 , and the steady-state value of the orbit coordination error is less than 10 -6 meters, indicating that the controller of the present invention can achieve high-precision spacecraft formation within a preset time.

[0082] Figure 5 is the motion trajectory of each spacecraft in the formation under the action of the controller in this paper in the LVLH system, from Figure 5 It can also be seen intuitively that the spacecraft can eventually form the desired formation configuration.

[0083] The above simulation results fully demonstrate that the present invention is able to achieve a high-precision spacecraft formation within a preset time in the presence of attitude-orbit coupling influence, external disturbances and model parameter uncertainty.

[0084] Those skilled in the art will appreciate that the embodiments described herein are intended to help readers understand the principles of the present invention, and should be understood that the scope of protection of the present invention is not limited to such specific statements and embodiments. For those skilled in the art, the present invention may have various changes and variations. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of the claims of the present invention.

Claims

1. A method for attitude-orbit coupling control of a distributed spacecraft formation with preset time, characterized in that: include: S1. Establishing the attitude-orbit coupling dynamics model of the spacecraft; Step S1 includes the following sub-steps: S11. For the n spacecraft in the formation, use MRPs to describe the spacecraft attitude and establish the attitude dynamics model of spacecraft i as follows: σ i represents the attitude of the i-th spacecraft system relative to the geocentric inertial coordinate system, Represents σ i The first derivative with respect to time, Represents σ i The second derivative with respect to time, w i represents the projection of the angular velocity of the spacecraft system relative to the ECI system on the system, J i represents the moment of inertia of the i-th spacecraft, S() represents the cross product matrix, τ i , τ di They represent the projections of the control torque and external disturbance torque acting on the i-th spacecraft in the spacecraft system, respectively. The superscript T indicates transposition; S12. Assuming that the constellation runs on a circular orbit, the relative dynamic equation of the i-th satellite relative to the constellation reference point is: Among them, m i represents the mass of the i-th spacecraft, ρ i represents the position of the i-th spacecraft relative to the reference point, Represents ρ i The first derivative of Represents ρ i The second-order derivative of represents the angular velocity of the reference point rotating around the earth, f bi 、F di They represent the projection and interference force of the control force of the i-th spacecraft in the system, R lbi represents the rotation matrix of the LVLH system from the i-th spacecraft local system to the reference point; S13, combining the spacecraft attitude dynamics model and the relative orbit dynamics model to establish the attitude-orbit coupling dynamics model of spacecraft i with normalized position; the specific process is: Let the state be in ρ max Represents the maximum value of the distance between all spacecraft and the reference point, combines the spacecraft attitude dynamics model and the relative orbit dynamics model, and obtains the attitude-orbit coupling model of the i-th spacecraft in the Euler-Lagrangian form: in, Represents x i The first derivative of Represents x i The second-order derivative of I3 represents the 3×3 identity matrix; S2. Construct a preset time function to specify the formation convergence time of the spacecraft; the preset time function is designed as follows; Among them, p0, p ∞ They represent the initial value and steady-state value of the preset time function, respectively, and T represents the preset system stabilization time; S3. Design a preset formation performance inequality according to the constructed preset time function; in step S3, the preset formation performance inequality is designed to be in the following form: -v 1i,m p(t)<e i,m (t)<v 2i,m p(t) Among them, e i,m Indicates e i The element in the mth column, e i represents the formation error of spacecraft i; v 1i,m and v 2i,m Respectively represent v 1i and v 2i The mth element of ; S4, designing a preset time formation control protocol according to the attitude-orbit coupling dynamics model of the spacecraft and the preset formation performance inequality, so as to realize the preset time spacecraft formation; step S4 specifically includes the following sub-steps: S41. The preset formation performance inequality is transformed into an equality constraint through error transformation: in, S42. Design the preset time formation control protocol of spacecraft i as follows: Among them, k 1i ,k 2i is a constant greater than 0, ε i =[ε i,1 ,…,ε i,6 ] T , for e i The derivative of S43, according to Calculate the control quantity of each spacecraft in the formation; S44, applying the control amount to the actuators of the corresponding spacecraft, so as to realize the spacecraft formation within a preset time.

Citation Information

Patent Citations

  • Spacecraft attitude-track integrated backstepping tracking control method

    CN106814746A

  • Four-rotor aircraft formation tracking control method

    CN112684705A

  • Fault diagnosis model construction method and device based on time convolution network

    CN113033786A

  • Spacecraft formation capture and collision avoidance control method based on disturbance observer

    CN113697130A

  • Satellite attitude determination and control system with agile beam sensing

    EP0322349A2