Flywheel dynamics coupled spacecraft formation attitude cooperative control method

By constructing a spacecraft formation attitude control method coupled with flywheel dynamics, the angular velocity of the spacecraft and the angular velocity of the flywheel are obtained, the Hamiltonian energy function and the navigator state are calculated, and the IDA-PBC algorithm is used to solve the problem of low rationality of attitude control in the existing technology. The problem of this has achieved higher accuracy and stable spacecraft formation attitude control.

CN118938976AActive Publication Date: 2024-11-12CENT SOUTH UNIV
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202410982480.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-12
Estimated Expiration
2044-07-22

AI Technical Summary

Technical Problem

The existing spacecraft formation attitude control method fails to effectively consider the coupling between the flywheel and the spacecraft dynamics, resulting in low rationality of attitude control and difficulty in achieving high-precision distributed collaborative control.

Method used

By obtaining the angular velocity of the spacecraft, attitude and flywheel, constructing attitude dynamics and kinematics equations, computing Hamiltonian energy function and the estimated state of the navigator, constructing PH equation and expected Hamiltonian function, and controlling using IDA-PBC algorithm calculation system The instrument equation obtains the spacecraft's control law equation and performs precise control.

Benefits of technology

It improves the rationality and accuracy of spacecraft attitude control, shortens the error convergence time, and maintains a more stable configuration.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938976A_ABST
    Figure CN118938976A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of spacecraft control, and provides a flywheel dynamics coupled spacecraft formation attitude cooperative control method, which comprises the following steps: acquiring a Hamiltonian energy function according to angular kinetic energy of a spacecraft and angular kinetic energy of a flywheel, and calculating a pilot estimation state according to attitude dynamics and a kinematics equation; constructing a PH equation of the target spacecraft formation according to all Hamiltonian energy functions and attitude dynamics and kinematics equations; constructing an expected Hamiltonian function of the target spacecraft formation based on attitude dynamics and kinematics equations of all spacecrafts and pilot estimation states of all spacecrafts; according to the PH equation and the expected Hamiltonian function, a system controller equation of the target spacecraft formation is obtained through calculation by means of an IDA-PBC algorithm, and a control law equation of the spacecrafts is obtained based on the system controller equation; and controlling the spacecraft by using the control law equation of the spacecraft. According to the method, the reasonability of spacecraft formation control can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of spacecraft control technology, and in particular to a spacecraft formation attitude collaborative control method coupled with flywheel dynamics. Background Art

[0002] Spacecraft formation attitude cooperative control refers to the control to ensure that the attitudes of all spacecraft maintain relative pointing or final trend consistency. It has attracted much attention due to its important role in formation tasks such as synthetic aperture imaging, gravity field measurement and three-dimensional stereo imaging. There are currently many methods for studying the problem of spacecraft attitude cooperative control. For example, in response to the requirement of maintaining the attitude alignment of multiple spacecraft during formation rotation maneuvers, existing studies have given a control law that superimposes three behaviors including reducing attitude errors, maintaining attitude consistency and rotating around a specified axis, as well as a passive dynamic control law that does not require angular velocity information. Existing studies have also given a decentralized control mechanism for spacecraft based on virtual structures to achieve strict relative position and attitude configuration during formation maneuvers.

[0003] Momentum exchange actuators, especially flywheels, are environmentally friendly and energy-saving spacecraft attitude control devices, and have been deeply studied in single spacecraft control. For example, the coplanar double flywheel-single jet configuration scheme stabilizes the angular velocity of the spacecraft through the double flywheel combination, so that the spacecraft can achieve the expected attitude maneuver with the most fuel savings. However, most of the existing spacecraft attitude cooperative control studies simplify the spacecraft as a rigid body and do not consider the role of momentum exchange actuators. The role of flywheels has been considered in a few attitude cooperative control studies, such as the study of the attitude cooperative control problem of flexible spacecraft formation considering the asymmetric actuator configuration, and the design of an integral sliding mode adaptive control law and a robust anti-saturation distributed attitude cooperative controller, so that the attitude and angular velocity can accurately track the expected time-varying instructions within a limited time. However, these studies did not consider the coupling between the flywheel and the spacecraft dynamics when designing the control law, and were not conducive to the realization of high-precision distributed cooperative control of the attitude of the spacecraft formation. It can be seen that the existing spacecraft cooperative control methods have the problem of low rationality of the attitude control of the spacecraft formation. Summary of the invention

[0004] The present application provides a spacecraft formation attitude collaborative control method coupled with flywheel dynamics, which can solve the problem of low rationality of attitude control of spacecraft formations.

[0005] In a first aspect, an embodiment of the present application provides a spacecraft formation attitude collaborative control method coupled with flywheel dynamics, the attitude collaborative control method comprising:

[0006] The angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation are obtained at the current moment, and the attitude dynamics and kinematics equations of each spacecraft are constructed according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft; the spacecraft is a spacecraft using a flywheel, and the attitude dynamics and kinematics equations are used to describe the attitude information, flywheel information and control information of the spacecraft;

[0007] For each spacecraft, the Hamiltonian energy function of the spacecraft is obtained according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and the navigator estimated state of the spacecraft is calculated according to the attitude dynamics and kinematic equations of all spacecraft; the Hamiltonian energy function is used to describe the angular kinetic energy of the spacecraft and the angular kinetic energy of the flywheel at the current moment, and the navigator estimated state is used to describe the expected state of the spacecraft;

[0008] According to the Hamiltonian energy function of all spacecraft and the attitude dynamics and kinematics equations, the PH equation of the target spacecraft formation is constructed; the PH equation is used to describe the relationship between the system controller of the target spacecraft formation and the attitudes of all spacecraft;

[0009] The expected Hamiltonian function of the target spacecraft formation is constructed based on the attitude dynamics and kinematic equations of all spacecraft and the navigator-estimated states of all spacecraft; the expected Hamiltonian function is used to describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft;

[0010] According to the PH equation and the expected Hamiltonian function, the system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm, and the control law equation of each spacecraft is obtained based on the system controller equation;

[0011] For each spacecraft, the control law equation of the spacecraft is used to control the spacecraft.

[0012] In a second aspect, an embodiment of the present application provides a spacecraft formation attitude cooperative control device coupled with flywheel dynamics, comprising:

[0013] An acquisition module is used to acquire the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation at the current moment, and to construct the attitude dynamics and kinematics equations of each spacecraft according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft; the spacecraft is a spacecraft using a flywheel, and the attitude dynamics and kinematics equations are used to describe the attitude information, flywheel information and control information of the spacecraft;

[0014] The first calculation module is used to obtain the Hamiltonian energy function of each spacecraft according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and calculate the navigator estimated state of the spacecraft according to the attitude dynamics and kinematic equations of all spacecraft; the Hamiltonian energy function is used to describe the angular kinetic energy of the spacecraft and the angular kinetic energy of the flywheel at the current moment, and the navigator estimated state is used to describe the expected state of the spacecraft;

[0015] The first building module is used to build the PH equation of the target spacecraft formation according to the Hamiltonian energy function and the attitude dynamics and kinematics equations of all spacecraft; the PH equation is used to describe the relationship between the system controller of the target spacecraft formation and the attitudes of all spacecraft;

[0016] The second building module is used to build the expected Hamiltonian function of the target spacecraft formation based on the attitude dynamics and kinematics equations of all spacecraft and the navigator-estimated states of all spacecraft; the expected Hamiltonian function is used to describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft;

[0017] The second calculation module is used to calculate the system controller equation of the target spacecraft formation according to the PH equation and the expected Hamiltonian function using the IDA-PBC algorithm, and obtain the control law equation of each spacecraft based on the system controller equation;

[0018] The control module is used to control each spacecraft by using the control law equation of the spacecraft.

[0019] In a third aspect, an embodiment of the present application provides a terminal device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned method for coordinated control of spacecraft formation attitudes coupled with flywheel dynamics when executing the above-mentioned computer program.

[0020] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, which stores a computer program, and when the computer program is executed by a processor, it implements the above-mentioned spacecraft formation attitude collaborative control method of coupled flywheel dynamics.

[0021] The above solution of the present application has the following beneficial effects:

[0022] In an embodiment of the present application, the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation are obtained at the current moment, and the attitude dynamics and kinematic equations of each spacecraft are constructed according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft. Then, for each spacecraft, the Hamiltonian energy function of the spacecraft is obtained according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and the navigator's estimated state of the spacecraft is calculated according to the attitude dynamics and kinematic equations of all spacecraft. Then, the PH equation of the target spacecraft formation is constructed according to the Hamiltonian energy function and the attitude dynamics and kinematic equations of all spacecraft. Then, based on the attitude dynamics and kinematic equations of all spacecraft and the navigator's estimated state of all spacecraft, the expected Hamiltonian function of the target spacecraft formation is constructed. Then, based on the PH equation and the expected Hamiltonian function, the system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm, and the control law equation of each spacecraft is obtained based on the system controller equation. Finally, for each spacecraft, the control law equation of the spacecraft is used to control the spacecraft. Among them, attitude dynamics and kinematic equations are constructed according to the flywheel angular momentum of the spacecraft, so that the dynamic information of the flywheel is coupled into the attitude dynamics and kinematic equations, thereby improving the accuracy and rationality of the equations in describing the spacecraft state. The navigator's estimated state obtained based on accurate and reasonable attitude dynamics and kinematic equations is highly accurate and can provide an accurate expected state for the spacecraft, thereby improving the accuracy of the expected Hamiltonian function. The rationality of the spacecraft control law equation obtained according to the expected Hamiltonian function with high accuracy is improved, thereby improving the rationality of the attitude control of the spacecraft formation, and can make the error converge faster and the configuration more stable.

[0023] Other beneficial effects of the present application will be described in detail in the subsequent specific implementation section. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0025] Figure 1 A flow chart of a spacecraft formation attitude cooperative control method coupled with flywheel dynamics provided in an embodiment of the present application;

[0026] Figure 2 A schematic diagram of the topological structure of a spacecraft formation provided in an embodiment of the present application;

[0027] Figure 3A schematic diagram of a spacecraft attitude trajectory provided in an embodiment of the present application;

[0028] Figure 4 A momentary graph of spacecraft attitude error provided by an embodiment of the present application;

[0029] Figure 5 A steady-state diagram of the spacecraft attitude error provided by an embodiment of the present application;

[0030] Figure 6 An instantaneous diagram of the spacecraft output torque provided by an embodiment of the present application;

[0031] Figure 7 A steady-state diagram of the spacecraft output torque provided in one embodiment of the present application;

[0032] Figure 8 A momentary graph of the relative attitude error of a spacecraft provided in an embodiment of the present application;

[0033] Fig. 9 A steady-state diagram of relative attitude error of a spacecraft provided in an embodiment of the present application;

[0034] Fig.10 A schematic diagram of the structure of a spacecraft formation attitude cooperative control device coupled with flywheel dynamics provided in one embodiment of the present application;

[0035] Fig.11 A schematic diagram of the structure of a terminal device provided in one embodiment of the present application. DETAILED DESCRIPTION

[0036] In the following description, specific details such as specific system structures, technologies, etc. are provided for the purpose of illustration rather than limitation, so as to provide a thorough understanding of the embodiments of the present application. However, it should be clear to those skilled in the art that the present application may also be implemented in other embodiments without these specific details. In other cases, detailed descriptions of well-known systems, devices, circuits, and methods are omitted to prevent unnecessary details from obstructing the description of the present application.

[0037] It should be understood that when used in the present specification and the appended claims, the term "comprising" indicates the presence of described features, wholes, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components and / or combinations thereof.

[0038] It should also be understood that the term “and / or” used in the specification and appended claims refers to any and all possible combinations of one or more of the associated listed items, and includes these combinations.

[0039] As used in the specification and appended claims of this application, the term "if" can be interpreted as "when" or "uponce" or "in response to determining" or "in response to detecting", depending on the context. Similarly, the phrase "if it is determined" or "if [described condition or event] is detected" can be interpreted as meaning "uponce it is determined" or "in response to determining" or "uponce [described condition or event] is detected" or "in response to detecting [described condition or event]", depending on the context.

[0040] In addition, in the description of the present application specification and the appended claims, the terms "first", "second", "third", etc. are only used to distinguish the descriptions and cannot be understood as indicating or implying relative importance.

[0041] References to "one embodiment" or "some embodiments" etc. described in the specification of this application mean that one or more embodiments of the present application include specific features, structures or characteristics described in conjunction with the embodiment. Therefore, the statements "in one embodiment", "in some embodiments", "in some other embodiments", "in some other embodiments", etc. that appear in different places in this specification do not necessarily refer to the same embodiment, but mean "one or more but not all embodiments", unless otherwise specifically emphasized in other ways. The terms "including", "comprising", "having" and their variations all mean "including but not limited to", unless otherwise specifically emphasized in other ways.

[0042] In view of the problem of low rationality of attitude control of existing spacecraft formations, an embodiment of the present application provides a spacecraft formation attitude collaborative control method coupled with flywheel dynamics. The spacecraft formation attitude collaborative control method obtains the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation at the current moment, and constructs the attitude dynamics and kinematic equations of each spacecraft according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft, and then obtains the Hamiltonian energy function of the spacecraft according to the angular velocity of the spacecraft and the angular velocity of the flywheel for each spacecraft, and calculates the attitude dynamics and kinematic equations of all spacecraft according to the attitude dynamics and kinematic equations of all spacecraft. The navigator of the spacecraft estimates the state, and then constructs the PH equation of the target spacecraft formation based on the Hamiltonian energy function, attitude dynamics and kinematic equations of all spacecraft. Then, the expected Hamiltonian function of the target spacecraft formation is constructed based on the attitude dynamics and kinematic equations of all spacecraft and the navigator's estimated state of all spacecraft. Then, based on the PH equation and the expected Hamiltonian function, the IDA-PBC algorithm is used to calculate the system controller equation of the target spacecraft formation, and the control law equation of each spacecraft is obtained based on the system controller equation. Finally, for each spacecraft, the control law equation of the spacecraft is used to control the spacecraft. Among them, attitude dynamics and kinematic equations are constructed according to the flywheel angular momentum of the spacecraft, so that the dynamic information of the flywheel is coupled into the attitude dynamics and kinematic equations, thereby improving the accuracy and rationality of the equations in describing the spacecraft state. The navigator's estimated state obtained based on accurate and reasonable attitude dynamics and kinematic equations is highly accurate and can provide an accurate expected state for the spacecraft, thereby improving the accuracy of the expected Hamiltonian function. The rationality of the spacecraft control law equation obtained according to the expected Hamiltonian function with high accuracy is improved, thereby improving the rationality of the attitude control of the spacecraft formation, and can make the error converge faster and the configuration more stable.

[0043] Next, the spacecraft formation attitude collaborative control method coupled with flywheel dynamics provided in this application is exemplified.

[0044] like Figure 1 As shown, the spacecraft formation attitude cooperative control method coupled with flywheel dynamics provided in the present application includes the following steps:

[0045] Step 11, obtain the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation at the current moment, and construct the attitude dynamics and kinematics equations of each spacecraft according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft.

[0046] The above-mentioned spacecraft is a spacecraft using a flywheel, that is, a rigid body spacecraft under the action of a flywheel group (three flywheels are respectively distributed on the three inertial axes of the spacecraft's body coordinate system). The attitude dynamics and kinematic equations are used to describe the spacecraft's attitude information, flywheel information and control information.

[0047] In some embodiments of the present application, the angular velocity, attitude and angular velocity of the flywheel of the spacecraft may be acquired through the control system of the spacecraft.

[0048] Specifically, the attitude dynamics and kinematics equations are:

[0049]

[0050] Among them, q i represents the attitude error quaternion of the i-th spacecraft, i = 1, 2, ..., n, n represents the number of spacecraft in the target spacecraft formation, q i1 Represents the first element of the attitude error, q i2 Represents the second element of the attitude error, q i3 Represents the third element of the attitude error, q i4 Represents the fourth element of attitude error, represents the direction angle of the i-th spacecraft, e1 represents the component of the unit vector e in the horizontal direction, e2 represents the component of the unit vector e in the vertical direction, e3 represents the component of the unit vector e in the vertical direction, Ω(q i ) represents the matrix composed of attitude quaternions, P i represents the angular momentum of the i-th spacecraft, P i =Iω i , I represents the moment of inertia matrix, ω i represents the angular velocity of the i-th spacecraft, represents the derivative of the attitude error quaternion of the i-th spacecraft, represents the derivative of the angular momentum of the i-th spacecraft, u i represents the flywheel output torque of the i-th spacecraft, u i =[u i1 ,u i2 ,u i3 ] T ,u i1 represents the flywheel output torque component of the i-th spacecraft along the first coordinate axis, u i2 represents the flywheel output torque component of the i-th spacecraft along the second coordinate axis, u i3 represents the flywheel output torque component of the i-th spacecraft along the third coordinate axis, Q i represents the angular velocity of the flywheel of the i-th spacecraft, represents the derivative of the angular velocity of the flywheel of the i-th spacecraft, F i represents the moment of inertia matrix of the flywheel of the i-th spacecraft, θ i represents the rotation angle of the flywheel of the i-th spacecraft, θ i =[θ i1 ,θ i2 ,θ i3 ] T ,θ i1 represents the rotation angle of the flywheel of the i-th spacecraft along the first coordinate axis, θ i2 represents the rotation angle of the flywheel of the i-th spacecraft along the second coordinate axis, θ i3 represents the rotation angle of the flywheel of the i-th spacecraft along the third coordinate axis, represents the angular velocity of the flywheel of the i-th spacecraft, P i +Q i =BP i0 , P i0 represents the initial angular momentum of the system, B represents the system transformation matrix, ω i * Represents the angular velocity component matrix of the i-th spacecraft:

[0051]

[0052] Among them, ω i1 represents the angular velocity component of the i-th spacecraft along the first coordinate axis, ω i2 represents the angular velocity component of the i-th spacecraft along the second coordinate axis, ω i3 Represents the angular velocity component of the i-th spacecraft along the direction of the third coordinate axis.

[0053] It should be noted that the first coordinate axis, the second coordinate axis, and the third coordinate axis are all coordinate axes in the body coordinate system of the spacecraft. The system transformation matrix B is specifically:

[0054]

[0055] For example, computer software such as MATLAB can be used to construct the attitude dynamics and kinematics equations of the spacecraft.

[0056] It is worth mentioning that the attitude dynamics and kinematics equations are constructed based on the flywheel angular momentum of the spacecraft, so that the dynamic information of the flywheel is coupled into the attitude dynamics and kinematics equations, thereby improving the accuracy and rationality of the equations' description of the spacecraft state.

[0057] Step 12, for each spacecraft, obtain the Hamiltonian energy function of the spacecraft according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and calculate the navigator estimated state of the spacecraft according to the attitude dynamics and kinematic equations of all spacecraft.

[0058] The above Hamiltonian energy function is used to describe the angular kinetic energy of the spacecraft and the angular kinetic energy of the flywheel at the current moment. That is, the angular kinetic energy of the spacecraft is calculated based on the angular velocity, attitude and angular velocity of the flywheel at the current moment, as well as the relationship between the various parameters reflected by the attitude dynamics and kinematic equations. The above navigator estimated state is used to describe the expected state of the spacecraft.

[0059] In some embodiments of the present application, the steps of obtaining the Hamiltonian energy function of the spacecraft according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and calculating the navigator estimated state of the spacecraft according to the attitude dynamics and kinematic equations of all spacecraft are specifically as follows:

[0060] The first step is to obtain the Hamiltonian energy function of the spacecraft based on the angular velocity of the spacecraft and the angular velocity of the flywheel.

[0061] Specifically, the above Hamiltonian energy function is:

[0062]

[0063] Among them, H i (x i ) represents the Hamiltonian function value of the i-th spacecraft, x i represents the state of the i-th spacecraft, x i =(q i , P i , Q i ) T , I i represents the moment of inertia matrix of the i-th spacecraft.

[0064] In the second step, the navigator-estimated states of the spacecraft are calculated based on the attitude dynamics and kinematic equations of all spacecraft.

[0065] Specifically, through the formula:

[0066]

[0067] Calculate the navigator's estimated state x of the i-th spacecraft i R .

[0068] in, represents the derivative of the navigator's estimated state of the i-th spacecraft, b iirepresents the communication relationship between the ith spacecraft and the pilot spacecraft in the target spacecraft formation, λ represents the degree of dependence between the ith spacecraft and the pilot spacecraft, and x R Indicates the state of the pilot spacecraft, x R =(q R , P R , Q R ) T ,q R Represents the attitude error quaternion of the pilot spacecraft, P R is the angular momentum of the pilot spacecraft, Q R is the angular velocity of the pilot spacecraft's flywheel, represents the state derivative of the pilot spacecraft, a ij represents the connection relationship between the i-th spacecraft and the j-th spacecraft, represents the derivative of the navigator's estimated state of the jth spacecraft, x j R represents the navigator estimated state of the j-th spacecraft, i = 1, 2, ..., n, and n represents the number of spacecraft in the target spacecraft formation.

[0069] It should be noted that when there is a communication relationship between the i-th spacecraft and the pilot spacecraft, b ii ≠0, when there is no communication relationship between the i-th spacecraft and the pilot spacecraft, b ii = 0, when there is a connection between the i-th spacecraft and the j-th spacecraft, a ij ≠0, when there is no connection between the i-th spacecraft and the j-th spacecraft, a ij = 0. When the i-th spacecraft is the pilot spacecraft, the pilot estimated state is not calculated by the above calculation formula, and the pilot estimated state of the pilot spacecraft is the preset expected state.

[0070] Exemplarily, the above steps can be run using computer software such as MATLAB to obtain the Hamiltonian energy function and the navigator estimated state.

[0071] It is worth mentioning that the navigator's estimated state obtained based on accurate and reasonable attitude dynamics and kinematic equations is highly accurate and can provide the spacecraft with an accurate expected state.

[0072] Step 13, construct the PH equation of the target spacecraft formation based on the Hamiltonian energy function and attitude dynamics and kinematics equations of all spacecraft.

[0073] The above PH equation is used to describe the relationship between the system controller of the target spacecraft formation and the attitudes of all spacecraft.

[0074] In some embodiments of the present application, the above steps of constructing the PH equation of the target spacecraft formation according to the Hamiltonian energy function and attitude dynamics and kinematics equations of all spacecraft are specifically as follows:

[0075] The first step is to construct the Hamiltonian energy function of the formation system of the target spacecraft formation based on the Hamiltonian energy functions of all spacecraft.

[0076] Specifically, the Hamiltonian energy function of the formation system is:

[0077]

[0078] in, represents the Hamiltonian energy function value of the formation system, X represents the state of all spacecraft in the target spacecraft formation, x i ∈X,I n represents the n-th order identity matrix, represents the Kronecker product, and N represents the parameter matrix:

[0079]

[0080] Among them, 0 3×3 represents a zero matrix with three rows and three columns, 0 3×4 represents a zero matrix with three rows and four columns, 0 4×3 represents a zero matrix with four rows and three columns, 0 4×4 represents a zero matrix of four rows and four columns, I represents the rotational inertia matrix of all spacecraft, and F represents the rotational inertia matrix of the flywheels of all spacecraft.

[0081] It should be noted that, according to the characteristics of the PH control system, that is, a system composed of multiple PH systems is still a PH system, it can be deduced that the Hamiltonian energy function of the formation system of a spacecraft formation composed of multiple spacecraft can be obtained by the accumulation of the Hamiltonian energy functions of all spacecraft.

[0082] In the second step, the PH equation of the target spacecraft formation is obtained based on the Hamiltonian energy function of the formation system and the attitude dynamics and kinematic equations of all spacecraft.

[0083] Specifically, the PH equation is:

[0084]

[0085] in, represents the derivative of the states of all spacecraft in the target spacecraft formation, J represents the interconnection matrix, J = diag[J1, J2, ..., J n ], J1 represents the interconnection matrix of the first spacecraft, J2 represents the interconnection matrix of the second spacecraft, and J n represents the interconnection matrix of the nth spacecraft, represents the partial derivative of the Hamiltonian energy function of the formation system, I n represents the n-order identity matrix, G represents the first constant matrix, U represents the system controller of the target spacecraft formation, U = diag[u1, u2, ..., u n ], u1 represents the flywheel output torque of the first spacecraft, u2 represents the flywheel output torque of the second spacecraft, and u n represents the flywheel output torque of the nth spacecraft, and Y represents the spacecraft output.

[0086] It should be noted that the interconnection matrix of the first constant matrix G and the i-th spacecraft is:

[0087] G=[0 4×3 I3I3] T

[0088]

[0089] Among them, Ω(q i ) represents the value of the relationship matrix between the attitude and angular velocity of the i-th spacecraft, ω i * represents the angular velocity component matrix of the i-th spacecraft, F represents the moment of inertia matrix of the flywheels of all spacecraft, P i * represents the angular momentum component matrix of the spacecraft.

[0090] Exemplarily, the PH equation of the target spacecraft formation can be obtained by running the above steps using computer software such as Matlab.

[0091] Step 14, construct the expected Hamiltonian function of the target spacecraft formation based on the attitude dynamics and kinematic equations of all spacecraft and the navigator estimated states of all spacecraft.

[0092] The above expected Hamiltonian function is used to describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft.

[0093] Specifically, the expected Hamiltonian function is:

[0094]

[0095] in, represents the expected Hamiltonian function value, represents the attitude error between the state of the i-th spacecraft and the state estimated by the navigator of the i-th spacecraft, represents the relative attitude error between the state of the i-th spacecraft and the state of the j-th spacecraft, and M and N both represent weight coefficient matrices:

[0096]

[0097] Exemplarily, the expected Hamiltonian function of the target spacecraft formation can be constructed using computer software such as MATLAB.

[0098] It is worth mentioning that based on the accurate expected state of the spacecraft provided by the navigator's estimated state, the accuracy of the constructed expected Hamiltonian function is improved, which makes it possible to accurately describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft, further improving the accuracy of the error description of the spacecraft formation and the robustness of the expected Hamiltonian function.

[0099] Step 15, according to the PH equation and the expected Hamiltonian function, the system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm, and the control law equation of each spacecraft is obtained based on the system controller equation.

[0100] Interconnection and Damping Assignment-Passivity-Based Control (IDA-PBC) is a method specifically used to design the control law of PH systems. It uses state feedback to modify the interconnection and damping matrices of the system to configure a positive energy function for the system so that it can be used as the Lyapunov function of the closed-loop system. The system converted by the IDA-PBC algorithm is still a PH system. By configuring the system with the desired interconnection and damping matrices, the control law can be solved. The IDA-PBC algorithm can convert the spacecraft formation attitude error system into a passive output form, which can improve the robustness of the system.

[0101] In some embodiments of the present application, the steps of calculating the system controller equation of the target spacecraft formation using the IDA-PBC algorithm according to the PH equation and the expected Hamiltonian function, and obtaining the control law equation of each spacecraft based on the system controller equation are specifically as follows:

[0102] The first step is to construct a matching equation based on the expected Hamiltonian function and the PH equation.

[0103] Specifically, the matching equation is:

[0104]

[0105] Among them, I n represents the n-th order identity matrix, represents the Kronecker product, G ⊥ represents the second constant matrix, J represents the interconnection matrix, represents the partial derivative of the Hamiltonian energy function of the formation system, J dDenotes the system expected interconnection matrix, D d represents the system expected damping matrix, represents the partial derivative of the expected Hamiltonian function, and X represents the state system of the target spacecraft formation.

[0106] The second step is to solve the matching equations to obtain the relationship matrix between the attitude and angular velocity of each spacecraft.

[0107] Specifically, according to G ⊥ G = 0, and G ⊥ Full rank, G is acceptable ⊥ =[I4 0 4×3 0 4×3 ], and let J d and D d The elements in are:

[0108]

[0109]

[0110] in, represents the component matrix of the first row and first column of the expected interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and second column of the expected interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and third column of the expected interconnection matrix of the i-th spacecraft, represents the component matrix of the second row and second column of the desired interconnection matrix of the i-th spacecraft, represents the component matrix of the second row and third column of the desired interconnection matrix of the i-th spacecraft, represents the component matrix of the third row and third column of the desired interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and first column of the desired damping matrix of the i-th spacecraft, represents the component matrix of the first row and third column of the desired damping matrix of the i-th spacecraft, represents the component matrix of the second row and second column of the desired damping matrix of the i-th spacecraft, Represents the component matrix in the third row and third column of the desired damping matrix of the i-th spacecraft.

[0111] Substituting the above parameters into the matching equation and solving it, we get the relationship matrix between the attitude and angular velocity of the spacecraft:

[0112]

[0113] Among them, Ω(q i ) represents the value of the relationship matrix between the attitude and angular velocity of the i-th spacecraft, ω irepresents the angular velocity of the i-th spacecraft, represents the difference in attitude error quaternion between the i-th spacecraft and the j-th spacecraft, represents the component matrix of the first row and first column of the expected interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and first column of the desired damping matrix of the i-th spacecraft, M 11 Represents the element in the first row and first column of the weight coefficient matrix M, N 11 Represents the element in the first row and first column of the weight coefficient matrix N, l ii represents the sum of all connection relationships of the i-th spacecraft, The component matrix of the first row and second column of the expected interconnection matrix of the i-th spacecraft, M 22 Represents the element in the second row and second column of the weight coefficient matrix M, N 22 Represents the element in the second row and second column of the weight coefficient matrix N, represents the difference in angular momentum between the i-th spacecraft and the j-th spacecraft, represents the component matrix of the first row and third column of the expected interconnection matrix of the i-th spacecraft, The first row and third column of the desired damping matrix of the i-th spacecraft is represented by the component matrix, M 33 Represents the element in the third row and third column of the weight coefficient matrix M, N 33 Represents the element in the third row and third column of the weight coefficient matrix N, represents the difference in angular velocity of the flywheel between the i-th spacecraft and the j-th spacecraft.

[0114] It should be noted that according to q i ,ω i and θ i The arbitrariness of , the conditions satisfying the above relationship are: ω id =0,N 22 =0 3×3 , M 11 =N 11 =I4,M 22 =I3,M 33 =N 33 =I3.

[0115] The third step is to construct the system controller equations of the target spacecraft formation based on the relationship matrix of all spacecraft.

[0116] Specifically, the system controller equation of the target spacecraft formation is:

[0117]

[0118] Where U represents the system controller of the target spacecraft formation, J d represents the system expected interconnection matrix, J id ∈J d , J id represents the expected interconnection matrix of the i-th spacecraft, D d Denotes the system expected damping matrix, D id ∈D d , D id represents the expected damping matrix of the i-th spacecraft:

[0119]

[0120] Among them, 0 3×3 represents a zero matrix with three rows and three columns, 0 3×4 represents a zero matrix with three rows and four columns, 0 4×3 represents a zero matrix with four rows and three columns, 0 4×4 represents a zero matrix with four rows and four columns, k d1 represents the first damping coefficient, k d2 represents the second damping coefficient.

[0121] The fourth step is to obtain the control law equations of each spacecraft based on the system controller equations.

[0122] Specifically, the system controller equation of the target spacecraft formation is derived to obtain the control law equation of each spacecraft. The control law equation is:

[0123]

[0124] Among them, u i represents the flywheel output torque of the i-th spacecraft, represents the attitude error element of the i-th spacecraft, represents the angular momentum error of the i-th spacecraft, represents the angular velocity error of the flywheel of the i-th spacecraft, k d Represents the interconnection coefficient.

[0125] Exemplarily, the above steps may be run using computer software such as MATLAB to obtain the control law equations for each spacecraft in the target spacecraft formation.

[0126] It is worth mentioning that the accuracy of the system controller equation obtained according to the expected Hamiltonian function with high accuracy is improved, and the robustness is increased, thereby improving the rationality and accuracy of the spacecraft control law equation.

[0127] Step 16, for each spacecraft, use the control law equation of the spacecraft to control the spacecraft.

[0128] Specifically, for each spacecraft, the angular momentum of the spacecraft at the current position, the angular velocity of the flywheel and other relevant data are substituted into the control law equation of the spacecraft to obtain the target flywheel output torque of the spacecraft, and the flywheel of the spacecraft is controlled according to the target flywheel output torque.

[0129] Exemplarily, the target flywheel output torque may be input into a control system of a spacecraft flywheel, and the control system controls the flywheel according to a target control law to adjust the attitude of the spacecraft.

[0130] It is worth mentioning that the attitude dynamics and kinematics equations are constructed according to the flywheel angular momentum of the spacecraft, so that the dynamic information of the flywheel is coupled into the attitude dynamics and kinematics equations, thereby improving the accuracy and rationality of the equations in describing the spacecraft state. The navigator's estimated state obtained based on accurate and reasonable attitude dynamics and kinematics equations is highly accurate and can provide the spacecraft with an accurate expected state, thereby improving the accuracy of the expected Hamiltonian function. The rationality of the spacecraft control law equation obtained based on the expected Hamiltonian function with high accuracy is improved, thereby improving the rationality of the attitude control of the spacecraft formation.

[0131] Next, the attitude control method of the spacecraft formation of the present application is exemplified.

[0132] A spacecraft formation consisting of five spacecraft is used as the target spacecraft formation. Each spacecraft has a flywheel on each axis to form a flywheel group. The control goal is to control the spacecraft in the spacecraft formation from the initial attitude to the same desired attitude under the action of bounded environmental disturbance torque. The parameters of each spacecraft and the environmental disturbance torque are shown in Table 1.

[0133]

[0134] Table 1

[0135] In the simulation example, the distributed control of the spacecraft formation adopts a fixed directed topology connection, and the fourth spacecraft is the pilot spacecraft, such as Figure 2 As shown, the spacecraft are numbered 1, 2, 3, 4, and 5, polygons represent spacecraft, and lines with arrows represent the connection relationship between spacecraft.

[0136] Initial attitude of each spacecraft and expected attitude for:

[0137]

[0138] Among them, t d represents the desired phase, t d =5,Δ i =10(i-1), i=1, 2,...,5.

[0139] The above-mentioned spacecraft formation is simulated and controlled by adopting the attitude coordination control method of the present application, the method provided by the present application but removing the flywheel-related terms in the formula, and the virtual structure control method, respectively, and the damping coefficient k is used. d =6, interconnection coefficient k d =1, the simulation results are shown in Table 2.

[0140]

[0141] Table 2

[0142] Among them, Eq1, Eq2, Eq3, and Eq4 are attitude error quaternions.

[0143] It can be seen that under the control taking into account the flywheel dynamics, that is, the control of the method of the present application, the attitude error convergence time of the spacecraft is faster.

[0144] The spacecraft's attitude trajectory is Figure 3 As shown in the figure, the horizontal axis represents time (Time), the unit is second (s), and the vertical axis represents Figure 3 (a) is the variation curve of the first component q1 in the spacecraft attitude quaternion. Figure 3 (b) is the variation curve of the second component q2 in the spacecraft attitude quaternion. Figure 3 (c) is the variation curve of the third component q3 in the spacecraft attitude quaternion. Figure 3 (d) is the variation curve of the fourth component q4 in the spacecraft attitude quaternion, the solid line S i The i-th spacecraft controlled by the method of the present application, i=1, 2, ..., 5, the dotted line Sn i The point line Sc is the i-th spacecraft controlled by the method without considering the flywheel. i It is the i-th spacecraft controlled by the virtual structure control method. It can be seen from the figure that the control method of the present application can track the desired attitude faster and maintain stability.

[0145] The instantaneous graph of the spacecraft's attitude error is as follows: Figure 4 As shown, the steady-state diagram is Figure 5 As shown, Figure 4 and Figure 5 The horizontal axis represents time (Tim e ), in seconds (s), Figure 4 (a) and Figure 5 (a) represents the variation curve of the first dimension of the attitude error Eq1, Figure 4 (b) and Figure 5 (b) represents the variation curve of the second dimension of the attitude error Eq2, Figure 4 (c) and Figure 5(c) represents the variation curve of the third dimension of the attitude error Eq3, Figure 4 (d) and Figure 5 (d) represents the variation curve of the fourth dimension of the attitude error Eq4, and Figure 4 and Figure 5 Solid middle line SS i is the attitude error curve of the i-th spacecraft under the control of the method of this application, and the dotted line Sn-Sn i is the attitude error curve of the i-th spacecraft under the control method without considering the flywheel, and the dotted line Sc-Sc i is the attitude error curve of the i-th spacecraft under the control of the virtual structure control method.

[0146] The instantaneous diagram of the output torque of the spacecraft is as follows: Figure 6 As shown, the steady-state diagram is Figure 7 As shown, Figure 6 and Figure 7 The horizontal axis represents time (Tim e ), the unit is seconds (s), the vertical axis represents the value of output torque, the unit is Nm, Figure 6 (a) and Figure 7 (a) represents the curve of the change of the flywheel output torque on the horizontal axis, Figure 6 (b) and Figure 7 (b) represents the change curve of the flywheel output torque on the vertical axis, Figure 6 (c) and Figure 7 (c) represents the curve of the change of the flywheel output torque of the vertical axis, and Figure 6 and Figure 7 In the middle, the solid line S i The dotted line Sn is the i-th spacecraft controlled by the method of this application. i The point line Sc is the i-th spacecraft controlled by the method without considering the flywheel. i is the i-th spacecraft controlled by the virtual structure control method.

[0147] The instantaneous graph of the relative attitude error of the spacecraft is as follows: Figure 8 As shown, the steady-state diagram is Fig. 9 As shown, Figure 8 and Fig. 9 The horizontal axis represents time (Tim e ), the unit is seconds (s), the vertical axis represents the value of the relative attitude error, Figure 8 (a) and Fig. 9 (a) represents the variation curve of the first dimension of relative attitude error Eq1, Figure 8 (b) and Fig. 9 (b) represents the variation curve of the second dimension of relative attitude error Eq2, Figure 8 (c) and Fig. 9 (c) represents the variation curve of the third dimension of relative attitude error Eq3, Figure 8(d) and Fig. 9 (d) represents the variation curve of the fourth dimension of the relative attitude error Eq4, and Figure 8 and Fig. 9 , the five solid lines all represent the relative attitude errors between the spacecraft under the control of the method of the present application, which are the relative attitude error curves S1-S4 between the first and fourth spacecraft, the relative attitude error curves S2-S4 between the second and fourth spacecraft, the relative attitude error curves S3-S4 between the third and fourth spacecraft, the relative attitude error curves S4-S4 between the fourth and fourth spacecraft, and the relative attitude error curves S5-S4 between the fifth and fourth spacecraft; the five dotted lines all represent the relative attitude errors between the spacecraft under the control method without considering the flywheel, which are the relative attitude error curves Sn1-Sn4 between the first and fourth spacecraft, the relative attitude error curves Sn2-Sn4 between the second and fourth spacecraft, and the relative attitude error curves S5-S4 between the third and fourth spacecraft. The relative attitude error curve Sn3-Sn4 between the spacecraft and the fourth spacecraft, the relative attitude error curve Sn4-Sn4 between the fourth spacecraft and the fourth spacecraft, and the relative attitude error curve Sn5-Sn4 between the fifth spacecraft and the fourth spacecraft; the five dotted lines all represent the relative attitude errors between spacecraft under the control of the virtual structure control method, namely the relative attitude error curve Sc1-Sc4 between the first spacecraft and the fourth spacecraft, the relative attitude error curve Sc2-Sc4 between the second spacecraft and the fourth spacecraft, the relative attitude error curve Sc3-Sc4 between the third spacecraft and the fourth spacecraft, the relative attitude error curve Sc4-Sc4 between the fourth spacecraft and the fourth spacecraft, and the relative attitude error curve Sc5-Sc4 between the fifth spacecraft and the fourth spacecraft.

[0148] It can be seen that under the control of the attitude collaborative control method considering the flywheel of the spacecraft provided in the present application, the convergence speed of the spacecraft's attitude error and relative attitude error are faster than the other two methods, and the accuracy and robustness of the spacecraft's attitude control are high.

[0149] The spacecraft formation device coupled with flywheel dynamics provided in the present application is exemplarily described below.

[0150] like Fig.10 As shown, an embodiment of the present application provides a spacecraft formation attitude cooperative control device coupled with flywheel dynamics, and the spacecraft formation attitude cooperative control device 1000 coupled with flywheel dynamics includes:

[0151] The acquisition module 1001 is used to acquire the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation at the current moment, and construct the attitude dynamics and kinematics equations of each spacecraft according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft; if the spacecraft uses a flywheel, the attitude dynamics and kinematics equations are used to describe the attitude information, flywheel information and control information of the spacecraft;

[0152] The first calculation module 1002 is used to obtain the Hamiltonian energy function of each spacecraft according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and calculate the navigator estimated state of the spacecraft according to the attitude dynamics and kinematics equations of all spacecraft; the Hamiltonian energy function is used to describe the angular kinetic energy of the spacecraft and the angular kinetic energy of the flywheel at the current moment, and the navigator estimated state is used to describe the expected state of the spacecraft;

[0153] The first construction module 1003 is used to construct the PH equation of the target spacecraft formation according to the Hamiltonian energy function and the attitude dynamics and kinematics equations of all spacecraft; the PH equation is used to describe the relationship between the system controller of the target spacecraft formation and the attitudes of all spacecraft;

[0154] The second construction module 1004 is used to construct the expected Hamiltonian function of the target spacecraft formation based on the attitude dynamics and kinematics equations of all spacecraft and the navigator estimated states of all spacecraft; the expected Hamiltonian function is used to describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft;

[0155] The second calculation module 1005 is used to calculate the system controller equation of the target spacecraft formation using the IDA-PBC algorithm according to the PH equation and the expected Hamiltonian function, and obtain the control law equation of each spacecraft based on the system controller equation;

[0156] The control module 1006 is used to control each spacecraft using the control law equation of the spacecraft.

[0157] It should be noted that the information interaction, execution process, etc. between the above-mentioned devices / units are based on the same concept as the method embodiment of the present application. Their specific functions and technical effects can be found in the method embodiment part and will not be repeated here.

[0158] The technicians in the relevant field can clearly understand that for the convenience and simplicity of description, only the division of the above-mentioned functional units and modules is used as an example for illustration. In practical applications, the above-mentioned function allocation can be completed by different functional units and modules as needed, that is, the internal structure of the device can be divided into different functional units or modules to complete all or part of the functions described above. The functional units and modules in the embodiment can be integrated in a processing unit, or each unit can exist physically separately, or two or more units can be integrated in one unit. The above-mentioned integrated unit can be implemented in the form of hardware or in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application. The specific working process of the units and modules in the above-mentioned system can refer to the corresponding process in the aforementioned method embodiment, which will not be repeated here.

[0159] like Fig.11 As shown, an embodiment of the present application provides a terminal device. The terminal device D10 of this embodiment includes: at least one processor D100 ( Fig.11 Only one processor is shown in the figure), a memory D101, and a computer program D102 stored in the memory D101 and executable on the at least one processor D100, wherein the processor D100 implements the steps of any of the above-mentioned method embodiments when executing the computer program D102.

[0160] Specifically, when the processor D100 executes the computer program D102, the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation are obtained at the current moment, and the attitude dynamics and kinematic equations of each spacecraft are constructed according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft. Then, for each spacecraft, the Hamiltonian energy function of the spacecraft is obtained according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and the navigator estimated state of the spacecraft is calculated according to the attitude dynamics and kinematic equations of all spacecraft. Then, the PH equation of the target spacecraft formation is constructed according to the Hamiltonian energy function and the attitude dynamics and kinematic equations of all spacecraft. Then, the expected Hamiltonian function of the target spacecraft formation is constructed based on the attitude dynamics and kinematic equations of all spacecraft and the navigator estimated state of all spacecraft. Then, according to the PH equation and the expected Hamiltonian function, the system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm, and the control law equation of each spacecraft is obtained based on the system controller equation. Finally, for each spacecraft, the control law equation of the spacecraft is used to control the spacecraft. Among them, attitude dynamics and kinematic equations are constructed according to the flywheel angular momentum of the spacecraft, so that the dynamic information of the flywheel is coupled into the attitude dynamics and kinematic equations, thereby improving the accuracy and rationality of the equations in describing the spacecraft state. The navigator's estimated state obtained based on accurate and reasonable attitude dynamics and kinematic equations is highly accurate and can provide an accurate expected state for the spacecraft, thereby improving the accuracy of the expected Hamiltonian function. The rationality of the spacecraft control law equation obtained according to the expected Hamiltonian function with high accuracy is improved, thereby improving the rationality of the attitude control of the spacecraft formation, and can make the error converge faster and the configuration more stable.

[0161] The processor D100 may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.

[0162] In some embodiments, the memory D101 may be an internal storage unit of the terminal device D10, such as a hard disk or memory of the terminal device D10. In other embodiments, the memory D101 may also be an external storage device of the terminal device D10, such as a plug-in hard disk, a smart memory card (SMC, SmartMedia Card), a secure digital (SD, Secure Digital) card, a flash card (Flash Card), etc. equipped on the terminal device D10. Further, the memory D101 may also include both an internal storage unit of the terminal device D10 and an external storage device. The memory D101 is used to store an operating system, an application program, a boot loader (BootLoader), data and other programs, such as the program code of the computer program, etc. The memory D101 may also be used to temporarily store data that has been output or is to be output.

[0163] An embodiment of the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps in the above-mentioned method embodiments can be implemented.

[0164] An embodiment of the present application provides a computer program product. When the computer program product is run on a terminal device, the terminal device can implement the steps in the above-mentioned method embodiments when executing the computer program product.

[0165] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present application implements all or part of the processes in the above-mentioned embodiment method, which can be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium. When the computer program is executed by the processor, the steps of the above-mentioned various method embodiments can be implemented. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may at least include: any entity or device, recording medium, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), electric carrier signal, telecommunication signal and software distribution medium that can carry the computer program code to the spacecraft formation attitude cooperative control method device / terminal device coupled with flywheel dynamics. For example, a USB flash drive, a mobile hard disk, a magnetic disk or an optical disk. In some jurisdictions, according to legislation and patent practice, computer-readable media cannot be electric carrier signals and telecommunication signals.

[0166] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0167] Those of ordinary skill in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.

[0168] The above is a preferred embodiment of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles described in the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.

Claims

1. A spacecraft formation attitude cooperative control method coupled with flywheel dynamics, It is characterized in that include: Acquire the angular velocity, attitude and angular velocity of the flywheel of each spacecraft in the target spacecraft formation at the current moment, and construct the attitude dynamics and kinematics equations of each spacecraft according to the angular velocity, attitude and angular velocity of the flywheel of each spacecraft; the spacecraft is a spacecraft using a flywheel, and the attitude dynamics and kinematics equations are used to describe the attitude information, flywheel information and control information of the spacecraft; For each of the spacecraft, respectively, a Hamiltonian energy function of the spacecraft is obtained according to the angular velocity of the spacecraft and the angular velocity of the flywheel, and the navigator estimated state of the spacecraft is calculated according to the attitude dynamics and kinematic equations of all spacecraft; the Hamiltonian energy function is used to describe the angular kinetic energy of the spacecraft and the angular kinetic energy of the flywheel at the current moment, and the navigator estimated state is used to describe the expected state of the spacecraft; Constructing the PH equation of the target spacecraft formation according to the Hamiltonian energy function and the attitude dynamics and kinematics equations of all spacecraft; the PH equation is used to describe the relationship between the system controller of the target spacecraft formation and the attitudes of all spacecraft; constructing an expected Hamiltonian function of the target spacecraft formation based on attitude dynamics and kinematic equations of all spacecraft and navigator-estimated states of all spacecraft; the expected Hamiltonian function is used to describe the attitude error of each spacecraft and the relative attitude error between every two spacecraft; According to the PH equation and the expected Hamiltonian function, the system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm, and the control law equation of each spacecraft is obtained based on the system controller equation; For each of the spacecraft, the control law equation of the spacecraft is used to control the spacecraft.

2. The spacecraft formation attitude cooperative control method according to claim 1, It is characterized in that The attitude dynamics and kinematics equations are: Among them, q i represents the attitude error quaternion of the i-th spacecraft, i = 1, 2, ..., n, n represents the number of spacecraft in the target spacecraft formation, q i1 Represents the first element of the attitude error, q i2 Represents the second element of the attitude error, q i3 Represents the third element of the attitude error, q i4 Represents the fourth element of attitude error, represents the direction angle of the i-th spacecraft, e 1 represents the component of the unit vector e in the horizontal direction, e 2 represents the component of the unit vector e in the vertical direction, e 3 represents the component of the unit vector e in the vertical direction, Ω(q i ) represents the matrix composed of attitude quaternions, P i represents the angular momentum of the i-th spacecraft, P i =Iω i , I represents the moment of inertia matrix, ω i represents the angular velocity of the i-th spacecraft, represents the derivative of the attitude error quaternion of the i-th spacecraft, represents the derivative of the angular momentum of the i-th spacecraft, u i represents the flywheel output torque of the i-th spacecraft, u i =[u i1 ,u i2 ,u i3 ] T ,u i1 represents the flywheel output torque component of the i-th spacecraft along the first coordinate axis, u i2 represents the flywheel output torque component of the i-th spacecraft along the second coordinate axis, u i3 represents the flywheel output torque component of the i-th spacecraft along the third coordinate axis, Q i represents the angular velocity of the flywheel of the i-th spacecraft, represents the derivative of the angular velocity of the flywheel of the i-th spacecraft, F i represents the moment of inertia matrix of the flywheel of the i-th spacecraft, θ i represents the rotation angle of the flywheel of the i-th spacecraft, θ i =[θ i1 ,θ i2 ,θ i3 ] T ,θ i1 represents the rotation angle of the flywheel of the i-th spacecraft along the first coordinate axis, θ i2 represents the rotation angle of the flywheel of the i-th spacecraft along the second coordinate axis, θ i3 represents the rotation angle of the flywheel of the i-th spacecraft along the third coordinate axis, represents the angular velocity of the flywheel of the i-th spacecraft, P i +Q i =BP i0 , P i0 represents the initial angular momentum of the system, B represents the system transformation matrix, ω i * Represents the angular velocity component matrix of the i-th spacecraft: Among them, ω i1 represents the angular velocity component of the i-th spacecraft along the first coordinate axis, ω i2 represents the angular velocity component of the i-th spacecraft along the second coordinate axis, ω i3 represents the angular velocity component of the i-th spacecraft along the direction of the third coordinate axis.

3. The spacecraft formation attitude coordinated control method according to claim 2, It is characterized in that The Hamiltonian energy function is: Among them, H i (x i ) represents the Hamiltonian function value of the i-th spacecraft, x i represents the state of the i-th spacecraft, x i =(q i ,P i ,Q i ) T , I i represents the moment of inertia matrix of the i-th spacecraft.

4. The spacecraft formation attitude cooperative control method according to claim 1, It is characterized in that The calculating the navigator estimated state of the spacecraft according to the attitude dynamics and kinematic equations of all spacecraft includes: By formula: Calculate the navigator estimated state of the i-th spacecraft in, represents the derivative of the navigator's estimated state of the i-th spacecraft, b ii represents the communication relationship between the i-th spacecraft and the pilot spacecraft in the target spacecraft formation, λ represents the degree of dependence between the i-th spacecraft and the pilot spacecraft, and x R represents the state of the pilot spacecraft, x R =(q R ,P R ,Q R ) T ,q R represents the attitude error quaternion of the pilot spacecraft, P R represents the angular momentum of the pilot spacecraft, Q R represents the angular velocity of the flywheel of the pilot spacecraft, represents the state derivative of the pilot spacecraft, a ij represents the connection relationship between the i-th spacecraft and the j-th spacecraft, represents the derivative of the navigator's estimated state of the j-th spacecraft, represents the navigator estimated state of the j-th spacecraft, i=1,2,...,n, and n represents the number of spacecraft in the target spacecraft formation.

5. The spacecraft formation attitude coordinated control method according to claim 3, It is characterized in that The PH equation of the target spacecraft formation is constructed according to the Hamiltonian energy function and attitude dynamics and kinematics equations of all spacecraft, including: Constructing a formation system Hamiltonian energy function of the target spacecraft formation according to the Hamiltonian energy functions of all spacecraft; The PH equation of the target spacecraft formation is obtained based on the Hamiltonian energy function of the formation system and the attitude dynamics and kinematics equations of all spacecraft.

6. The spacecraft formation attitude coordinated control method according to claim 5, It is characterized in that The Hamiltonian energy function of the formation system is: in, represents the Hamiltonian energy function value of the formation system, X represents the state of all spacecraft in the target spacecraft formation, x i ∈X,I n represents the n-th order identity matrix, represents the Kronecker product, Represents the parameter matrix: Among them, 0 3×3 represents a zero matrix with three rows and three columns, 0 3×4 represents a zero matrix with three rows and four columns, 0 4×3 represents a zero matrix with four rows and three columns, 0 4×4 represents a zero matrix of four rows and four columns, I represents the moment of inertia matrix of all spacecraft, and F represents the moment of inertia matrix of the flywheel of all spacecraft; The PH equation is: in, represents the derivative of the states of all spacecraft in the target spacecraft formation, J represents the interconnection matrix, J = diag[J 1 ,J 2 ,...,J n ], J 1 represents the interconnection matrix of the first spacecraft, J 2 represents the interconnection matrix of the second spacecraft, J n represents the interconnection matrix of the nth spacecraft, represents the partial derivative of the Hamiltonian energy function of the formation system, I n represents the n-th order identity matrix, G represents the first constant matrix, U represents the system controller of the target spacecraft formation, U = diag[u 1 ,u 2 ,...,u n ],u 1 represents the flywheel output torque of the first spacecraft, u 2 represents the flywheel output torque of the second spacecraft, u n represents the flywheel output torque of the nth spacecraft, and Y represents the spacecraft output.

7. The spacecraft formation attitude coordinated control method according to claim 4, It is characterized in that The expected Hamiltonian function is: in, represents the expected Hamiltonian function value, represents the attitude error between the state of the i-th spacecraft and the navigator-estimated state of the i-th spacecraft, represents the relative attitude error between the state of the i-th spacecraft and the state of the j-th spacecraft, and M and N both represent weight coefficient matrices.

8. The spacecraft formation attitude coordinated control method according to claim 7, It is characterized in that The system controller equation of the target spacecraft formation is calculated using the IDA-PBC algorithm according to the PH equation and the expected Hamiltonian function, including: Constructing a matching equation according to the expected Hamiltonian function and the PH equation; Solving the matching equation to obtain a relationship matrix between the attitude and angular velocity of each of the spacecraft; The system controller equation of the target spacecraft formation is constructed based on the relationship matrix of all spacecraft.

9. The spacecraft formation attitude cooperative control method according to claim 8, It is characterized in that The matching equation is: Among them, I n represents the n-th order identity matrix, represents the Kronecker product, G ⊥ represents the second constant matrix, J represents the interconnection matrix, represents the partial derivative of the Hamiltonian energy function of the formation system, J d Denotes the system expected interconnection matrix, D d represents the system expected damping matrix, represents the partial derivative of the expected Hamiltonian function, and X represents the state system of the target spacecraft formation; The relationship matrix between the attitude and angular velocity of each of the spacecraft is: Among them, Ω(q i ) represents the value of the relationship matrix between the attitude and angular velocity of the i-th spacecraft, ω i represents the angular velocity of the i-th spacecraft, represents the difference in attitude error quaternion between the i-th spacecraft and the j-th spacecraft, represents the component matrix of the first row and first column of the desired interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and first column of the desired damping matrix of the i-th spacecraft, M 11 Represents the element in the first row and first column of the weight coefficient matrix M, N 11 Represents the element in the first row and first column of the weight coefficient matrix N, l ii represents the sum of all connection relationships of the i-th spacecraft, represents the component matrix of the first row and second column of the desired interconnection matrix of the i-th spacecraft, M 22 Represents the element in the second row and second column of the weight coefficient matrix M, N 22 Represents the element in the second row and second column of the weight coefficient matrix N, represents the difference in angular momentum between the i-th spacecraft and the j-th spacecraft, represents the component matrix of the first row and third column of the desired interconnection matrix of the i-th spacecraft, represents the component matrix of the first row and third column of the desired damping matrix of the i-th spacecraft, M 33 Represents the element in the third row and third column of the weight coefficient matrix M, N 33 Represents the element in the third row and third column of the weight coefficient matrix N, represents the difference in angular velocity of the flywheel between the i-th spacecraft and the j-th spacecraft; The system controller equation of the target spacecraft formation is: Wherein, U represents the system controller of the target spacecraft formation, J d represents the system expected interconnection matrix, J id ∈J d , J id represents the expected interconnection matrix of the i-th spacecraft, D d Denotes the system expected damping matrix, D id ∈D d , D id represents the expected damping matrix of the i-th spacecraft: Among them, 0 3×3 represents a zero matrix with three rows and three columns, 0 3×4 represents a zero matrix with three rows and four columns, 0 4×3 represents a zero matrix with four rows and three columns, 0 4×4 represents a zero matrix with four rows and four columns, k d1 represents the first damping coefficient, k d2 represents the second damping coefficient.

10. The spacecraft formation attitude cooperative control method according to claim 9, It is characterized in that The control law equation of each of the spacecraft is: Among them, u i represents the flywheel output torque of the i-th spacecraft, represents the attitude error element of the i-th spacecraft, represents the angular momentum error of the i-th spacecraft, represents the angular velocity error of the flywheel of the i-th spacecraft, k d Represents the interconnection coefficient.

Citation Information

Patent Citations

  • Continuous moment spacecraft attitude tracking control method based on proportional transformation

    CN115509245A

  • Spacecraft formation attitude cooperative control method based on event triggering

    CN115657698A

  • Spacecraft formation trajectory tracking distributed control method and related equipment

    CN116257084A

  • Spacecraft formation attitude directional cooperative control method and related equipment

    CN116466735A

  • Distributed state observer-based attitude cooperative control method for spacecraft formation with preset time and preset precision and control system thereof

    CN117193356A