Modeling method of spacecraft electromagnetic docking and separation attitude-orbit integrated kinetic model

By using trajectory linearization and approximate linearization methods, an integrated dynamic model of spacecraft electromagnetic docking and separation attitude and orbit was established, which solved the problem of strong nonlinearity and multiple coupling under multi-source disturbances such as unknown mass characteristics, and realized efficient control of spacecraft electromagnetic docking and separation.

CN118907438APending Publication Date: 2024-11-08XIAN UNIV OF SCI & TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410959617.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-17
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Existing technologies have failed to effectively address the strong nonlinearity and multiple coupling issues in the integrated dynamic model of spacecraft electromagnetic docking and separation attitude and orbit under multi-source disturbances such as unknown mass characteristics. In particular, the complex coupling between electromagnetic force, electromagnetic torque and the relative motion of the spacecraft during electromagnetic docking and separation increases the difficulty of modeling.

Method used

By employing trajectory linearization and approximate linearization methods, an integrated dynamic model of the spacecraft's electromagnetic docking and separation attitude and orbit is established. By setting the configuration of the energized coils and the magnetic moment vector, the disturbance torque is analyzed. Combined with the electromagnetic force/torque matrix expression, the coupling effect between the electromagnetic torque and the relative motion of the spacecraft is clarified, and unknown mass characteristic parameters are separated into comprehensive disturbances, thereby reducing the complexity of the model.

Benefits of technology

It achieves an approximate linearization of the integrated dynamic model of spacecraft electromagnetic docking and separation attitude and orbit under multi-source disturbances, reduces the complexity of nonlinear coupling, eliminates the need for mass characteristic parameter identification, and lays the foundation for the design of efficient control methods.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118907438A_ABST
    Figure CN118907438A_ABST
Patent Text Reader

Abstract

The invention provides a modeling method of a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model, belongs to the technical field of spacecraft attitude and orbit integrated dynamic modeling, and adopts an approximate linearization method to establish a spacecraft electromagnetic docking and separation dynamic attitude and orbit integrated linearization dynamic model. According to the method, the coupling action mechanism between electromagnetic force, electromagnetic torque and spacecraft relative motion in spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic modeling is clarified, the complexity of a conventional nonlinear coupling model is reduced, unknown quality characteristic parameters are separated to comprehensive interference, the purpose of no parameter identification is achieved, and the method has the advantages of being high in reliability and high in reliability. And a foundation is laid for the design of an efficient control method.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of spacecraft attitude-orbit integrated dynamics modeling, and in particular relates to a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics modeling method. Background Art

[0002] In the process of on-orbit construction of super-large spacecrafts, the spacecraft is often required to perform multiple maneuvers to achieve related tasks through on-orbit assembly / reorganization of small spacecraft with modular design. Especially for spacecraft equipped with optical precision instruments, traditional thrusters will produce plume pollution, docking impact, heat emission and other problems, which bring major challenges to the on-orbit assembly of spacecraft. The electromagnetic force used in the electromagnetic docking and separation technology of spacecraft is a non-contact field force with the advantages of continuity, reversibility and synchronous control. It is the premise to support its implementation of on-orbit assembly tasks without plume pollution, fuel consumption and multiple reversible maneuvers. It has a positive role in extending the on-orbit service life of spacecraft, expanding the functions of spacecraft, and improving the efficiency of on-orbit assembly / reorganization of spacecraft.

[0003] Since the electromagnetic force and electromagnetic torque are inversely proportional to the multiple powers of the relative distance between the tracking spacecraft and the target spacecraft, and are closely related to the relative motion distance and attitude of the two spacecraft, the spacecraft electromagnetic docking and separation attitude-orbit integrated model not only faces the nonlinearity and coupling problems of the conventional attitude-orbit integrated model, but also faces the strong nonlinearity and coupling problems caused by the electromagnetic force / torque, and the overall system presents the characteristics of strong nonlinearity and multiple coupling coexistence. In addition, the spacecraft electromagnetic docking and separation system also faces complex disturbances from multiple sources, such as the geomagnetic field, external interference, elliptical orbit eccentricity, unknown mass characteristics, and the interference torque caused by the misalignment between the center of mass of the electromagnetic docking and separation device and the center of mass of the spacecraft. Multiple factors further aggravate the difficulty of the spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics modeling under multi-source disturbances.

[0004] At present, there is no integrated dynamic modeling method for the attitude and orbit of spacecraft electromagnetic docking and separation that takes into account the above-mentioned complex disturbances from multiple sources such as unknown mass characteristics. Summary of the invention

[0005] In order to solve the strong nonlinearity and multiple coupling problems of the integrated dynamic model of electromagnetic docking and separation attitude and orbit of spacecraft under multi-source disturbances such as unknown mass characteristics, the present invention provides a modeling method of the integrated dynamic model of electromagnetic docking and separation attitude and orbit of spacecraft, specifically a modeling method of the integrated dynamic model of electromagnetic docking and separation attitude and orbit of spacecraft under multi-source disturbances.

[0006] In order to achieve the above object, the present invention provides the following technical solutions:

[0007] A method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model comprises the following steps:

[0008] Set the configuration of the energized coils and the magnetic moment vector of the energized coils in the unknown tracking spacecraft and the known target spacecraft, and establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft based on the two energized coil magnetic moment vectors and the two energized coil configurations; analyze the impact of external interference on electromagnetic docking, and based on the electromagnetic force / torque matrix expression, establish the interference torque matrix expression caused by the non-coincidence of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft;

[0009] Based on the interference moment matrix expression, the trajectory linearization method is used to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system, and the target spacecraft attitude dynamics equation is established in the target spacecraft body coordinate system.

[0010] The multiple coupling effects of electromagnetic force, electromagnetic torque, relative motion of two spacecraft and attitude motion of spacecraft in the electromagnetic docking and separation system of spacecraft are analyzed. The state space forms of attitude dynamics equations of tracking spacecraft and attitude dynamics equations of target spacecraft are merged by approximate linearization method, and an integrated attitude and orbit dynamics model of spacecraft electromagnetic docking and separation is established.

[0011] Preferably, the setting of the configuration of the energized coils and the magnetic moment vector of the energized coils in the unknown tracking spacecraft and the known target spacecraft specifically comprises the following steps:

[0012] Establish a local vertical and local horizontal coordinate system with the center of mass "CM" of the tracking spacecraft and the target spacecraft as the origin, and establish a tracking spacecraft body coordinate system and a target spacecraft body coordinate system with the center of mass of the tracking spacecraft and the target spacecraft as the origin and the principal axis of inertia as the coordinate axis;

[0013] The configuration of the powered coil of the tracking spacecraft (102) in the tracking spacecraft body coordinate system is given, including three powered coils C1 (1021), C2 (1022) and C3 (1023) whose central axes are parallelly distributed, and the position vectors are respectively and The magnetic moment vectors are expressed as:

[0014] in, To track the magnetic dipole moment of the powered coil C1 in the spacecraft, μ C2 is the magnetic dipole moment of the energized coil C2, μ C3 is the magnetic dipole moment of the energized coil C3;

[0015] The target spacecraft (103) is provided with a powered coil configuration, including a powered coil T1 (1031) whose center of mass coincides with the target spacecraft. The coordinate vector of the powered coil T1 (1031) in the target spacecraft body coordinate system is: The known magnetic moment vector is

[0016] Preferably, the method of establishing the matrix form expression of the geomagnetic field interference force / torque caused by the misalignment of the mass center of the energized coil with the mass center of the tracking spacecraft and the target spacecraft comprises the following steps:

[0017] According to the electromagnetic force / torque magnetic moment vector, the electromagnetic force / torque expression of the electromagnetic coil is constructed. Based on the electromagnetic force / torque expression of the electromagnetic coil, the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft is established in combination with the configuration of the energized coils in the tracking spacecraft and the target spacecraft.

[0018] Based on the matrix expression of electromagnetic force / torque in the tracking spacecraft and the target spacecraft, the interference force and interference torque of the two spacecraft during the electromagnetic docking process are analyzed, and the matrix expression of the geomagnetic field interference force / torque of the tracking spacecraft and the target spacecraft is established according to the analysis results;

[0019] Based on the matrix expression of the geomagnetic field interference force / torque on the tracking spacecraft and the target spacecraft, the interference torque caused by the misalignment between the center of mass of the energized coil and the center of mass of the spacecraft is analyzed, and the matrix expression of the interference torque is established.

[0020] Preferably, the method further includes converting the electromagnetic force / torque matrix expression into the electromagnetic force / torque vector expression, as follows:

[0021]

[0022] in, To track the position vector from the center of mass of the powered coil in the spacecraft to the center of mass of the powered coil in the target spacecraft, for The unit vector of for The mode of μ0 is the vacuum permeability, is the magnetic moment vector of the energized coil in the target spacecraft, To track the magnetic dipole moments of the powered coils C1, C2, and C3 in the spacecraft, where k = 1, 2, 3;

[0023] The matrix expression of the electromagnetic force / torque on the target spacecraft is as follows:

[0024]

[0025] in, Representation vector The matrix function of Representation vector With vector The function matrix of Representation Matrix Cross product, Representation vector Matrix function of , where k = 1, 2, 3;

[0026] The geomagnetic field interference force on the target spacecraft is:

[0027]

[0028] Among them, B E is the magnetic field intensity, ▽B E Represents vector B E The gradient of

[0029] The geomagnetic field disturbance torque on the target spacecraft is:

[0030]

[0031] in, represents the magnetic moment vector matrix of the energized coil in the target spacecraft in the target spacecraft body coordinate system, Representation Matrix Cross product, Represents the rotation matrix from the “CM” orbit coordinate system to the target spacecraft body coordinate system.

[0032] Preferably, the interference torque matrix expression caused by the misalignment of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft is:

[0033]

[0034] in, Representation Matrix The cross product of It represents the electromagnetic force matrix of the powered coil T1 in the target spacecraft in the “CM” orbital coordinate system subjected to the powered coils C1, C2 and C3 in the tracking spacecraft, Represents the rotation matrix from the “CM” orbital coordinate system to the target spacecraft body coordinate system, where k = 1, 2, 3.

[0035] Preferably, the expression in the form of interference moment matrix is ​​based on the trajectory linearization method to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system, and to establish the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system, which specifically includes the following steps:

[0036] In the "CM" orbital coordinate system, the orbital dynamics equations of the tracking spacecraft and the target spacecraft are obtained based on the TH equation. The orbital dynamics model of electromagnetic docking and separation of the spacecraft is obtained by subtracting the orbital dynamics equations of the tracking spacecraft and the target spacecraft:

[0037]

[0038] in, represents the position vector of the target spacecraft pointing to the tracking spacecraft in the “CM” orbital coordinate system, express The first-order differential of express The second-order differential of represents the orbital dynamics coefficient matrix, represents the mass of the tracking spacecraft m C and the target spacecraft mass m T The expression of represents the electromagnetic force exerted on the tracking spacecraft by the target spacecraft, w0(t) is the nominal interference force on the tracking spacecraft including the interference of the geomagnetic field;

[0039] Establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system;

[0040]

[0041] Among them, J C represents the inertia matrix of the tracking spacecraft body, represents the attitude angular velocity of the tracking spacecraft in the tracking spacecraft body coordinate system, express The first-order differential of represents the total moment on the tracking spacecraft in its body coordinate system;

[0042] Establishing the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system;

[0043]

[0044] Among them, J T represents the inertia matrix of the target spacecraft, represents the attitude angular velocity of the target spacecraft in the target spacecraft body coordinate system, express The first-order differential of It represents the total moment acting on the target spacecraft in its body coordinate system.

[0045] Preferably, the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model is:

[0046]

[0047] Among them, X(t) represents the state matrix of the spacecraft electromagnetic docking and separation attitude and orbit integrated system, A represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system matrix, B represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, u(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, Θ represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system interference coefficient matrix, w(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system comprehensive interference matrix.

[0048] Preferably, the method further includes separating unknown mass characteristic parameters into comprehensive interferences, and correcting the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model by comprehensive interferences to obtain a state space model of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model, wherein the state space model of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model is:

[0049]

[0050] Among them, X1(t) represents the corrected state matrix of the spacecraft electromagnetic docking and separation attitude and orbit integrated system, A1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system matrix, B1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, u1(t) represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, Θ1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system interference coefficient matrix, w1(t) represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system comprehensive interference matrix containing multi-source disturbances such as unknown mass characteristic parameters and elliptical orbit eccentricity.

[0051] The present invention also provides a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model modeling system, comprising:

[0052] The first model building module is used to set the configuration of the energized coils and the magnetic moment vectors of the energized coils in the unknown tracking spacecraft and the known target spacecraft, and establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft according to the two energized coil magnetic moment vectors and the two energized coil configurations; analyze the influence of external interference on electromagnetic docking, and based on the electromagnetic force / torque matrix expression, establish the interference torque matrix expression caused by the non-coincidence of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft;

[0053] The second model building module is used to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system and establish the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system based on the interference moment matrix expression by using the trajectory linearization method;

[0054] The third model building module is used to analyze the multiple coupling effects of electromagnetic force, electromagnetic torque, relative motion of two spacecraft and attitude motion of spacecraft in the electromagnetic docking and separation system of spacecraft. The state space form of the attitude dynamics equation of tracking spacecraft and the attitude dynamics equation of target spacecraft are merged by approximate linearization method to establish an integrated dynamics model of spacecraft electromagnetic docking and separation attitude and orbit.

[0055] The present invention also provides a computer-readable storage medium on which a computer program is stored. When the computer program is loaded by a processor, the steps of the method for modeling a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics model can be implemented.

[0056] The spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model modeling method provided by the present invention has the following beneficial effects:

[0057] The present invention takes the configuration of the energized coils in the tracking spacecraft and the known target spacecraft and the magnetic moment vector of the energized coils as parameters, and combines the influence of external interference on electromagnetic docking. Firstly, an expression in the form of an interference torque matrix caused by the non-coincidence of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft is established, and the coupling mechanism between the electromagnetic force, the electromagnetic torque and the relative motion of the spacecraft in the integrated dynamic model of electromagnetic docking and separation attitude and orbit of the spacecraft is clarified. An approximate linearization method is given to deal with the strong nonlinearity and multiple coupling effects of the electromagnetic docking attitude and orbit integrated system, which solves the strong nonlinearity and multiple coupling problems of the integrated dynamic model of electromagnetic docking and separation attitude and orbit of the spacecraft under multi-source disturbances such as unknown mass characteristics, reduces the complexity of conventional nonlinear coupling models, and does not require mass characteristic parameter identification, laying a foundation for the design of efficient control methods. BRIEF DESCRIPTION OF THE DRAWINGS

[0058] In order to more clearly illustrate the embodiment of the present invention and its design scheme, the following briefly introduces the drawings required for this embodiment. The drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0059] Figure 1 This is a flow chart of a method for modeling a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics model according to Example 1 of the present invention.

[0060] Figure 2 Configuration diagram of the electromagnetic docking device for the tracking spacecraft and the target spacecraft. DETAILED DESCRIPTION

[0061] In order to enable those skilled in the art to better understand the technical solution of the present invention and implement it, the present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. The following embodiments are only used to more clearly illustrate the technical solution of the present invention, and cannot be used to limit the scope of protection of the present invention.

[0062] Example 1

[0063] In this embodiment, the basic parameters related to electromagnetic docking and separation of spacecraft are selected, such as Figure 2 As shown, it includes: determining the configuration of the energized coils of the electromagnetic docking and separation device in the tracking spacecraft (102) and the target spacecraft (103), determining the position vector γ of the energized coil T1 (1031) in the target spacecraft in the spacecraft body coordinate system T1T and magnetic moment vector μ T1 , determine the position vector of the tracking spacecraft power coils C1 (1021), C2 (1022) and C3 (1023) in the tracking spacecraft body coordinate system as γ C1C , γ C2C and γ C3C , select the appropriate nominal mass m0 and nominal inertia matrix J0, and determine the initial state and relative distance between the tracking spacecraft and the target spacecraft during electromagnetic docking and separation.

[0064] Based on this, this embodiment adopts an approximate linearization method to establish an integrated dynamic model of electromagnetic docking and separation attitude and orbit of spacecraft without identifying mass characteristic parameters under the conditions of multi-source complex disturbances such as external interference such as the geomagnetic field, unknown mass characteristics, and elliptical orbit eccentricity.

[0065] Specifically, the present invention provides a method for modeling a dynamic model of electromagnetic docking and separation attitude and orbit of a spacecraft, specifically a method for modeling a dynamic model of electromagnetic docking and separation attitude and orbit of a spacecraft under multi-source disturbances such as unknown mass characteristics, such as Figure 1 As shown, the following steps are included:

[0066] S1. The electromagnetic docking device, i.e., the configuration of the energized coil in the tracking spacecraft and the target spacecraft is given, and the unknown magnetic moment vector of the energized coil in the tracking spacecraft and the known magnetic moment vector of the energized coil in the target spacecraft are set.

[0067] The implementation method is as follows:

[0068] S101. Establish a local vertical and local horizontal coordinate system with the center of mass "CM" of the tracking spacecraft and the target spacecraft as the origin, and establish a tracking spacecraft body coordinate system and a target spacecraft body coordinate system with the center of mass of the tracking spacecraft and the target spacecraft as the origin and the principal axis of inertia as the coordinate axis.

[0069] S102, a configuration of the energized coils of the tracking spacecraft (102) in the tracking spacecraft body coordinate system is given, including three energized coils C1 (1021), C2 (1022) and C3 (1023) whose central axes are parallelly distributed, and the position vectors are respectively and The magnetic moment vectors are expressed as in, To track the magnetic dipole moment of the powered coil C1 in the spacecraft, μ C2 is the magnetic dipole moment of the energized coil C2, μ C3 is the magnetic dipole moment of the energized coil C3.

[0070] S103, providing a configuration of a power coil of the target spacecraft (103), including a power coil T1 (1031) whose center of mass coincides with the target spacecraft, and a coordinate vector in the target spacecraft body coordinate system is: The known magnetic moment vector is

[0071] S2. Establish the matrix expression of electromagnetic force / torque in the tracking spacecraft and the target spacecraft, analyze the influence of external interference on the electromagnetic docking system, establish the matrix expression of the interference force / torque of the geomagnetic field on the tracking spacecraft and the target spacecraft, and the interference torque caused by the misalignment of the center of mass of the energized coil and the center of mass of the spacecraft. The implementation method is as follows:

[0072] S201. Based on the electromagnetic force / torque magnetic moment vector expression, establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft.

[0073] S202. During the electromagnetic docking process of the two spacecraft, the spacecraft will inevitably be affected by various interferences. The main interference forces and interference torques in this process are analyzed, and based on the matrix expression of the electromagnetic force / torque in the tracking spacecraft and the target spacecraft, the matrix expression of the interference force / torque model of the geomagnetic field on the tracking spacecraft and the target spacecraft is established.

[0074] S203. In terms of electromagnetic torque, the interference torque generated by the geomagnetic field is analyzed. The interference torque caused by the misalignment between the center of mass of the energized coil and the center of mass of the spacecraft in the tracking spacecraft and the target spacecraft is analyzed. Based on the matrix expression of the interference force / torque model of the geomagnetic field on the tracking spacecraft and the target spacecraft, the matrix expression of the torque model is established.

[0075] In this embodiment, the vector expression of the electromagnetic force / torque on the target spacecraft is as follows:

[0076]

[0077] in, To track the position vector from the center of mass of the powered coil in the spacecraft to the center of mass of the powered coil in the target spacecraft, for The unit vector of for The mode of μ0 is the vacuum permeability, is the magnetic moment vector of the energized coil in the target spacecraft, To track the magnetic moment vector of the powered coils C1, C2, and C3 in the spacecraft.

[0078] The matrix expression of the electromagnetic force / torque on the target spacecraft is as follows:

[0079]

[0080] in, Representation vector The matrix function of Representation vector With vector The function matrix of Representation Matrix Cross product, Representation vector Matrix function of .

[0081] The geomagnetic field interference force on the target spacecraft is:

[0082]

[0083] Among them, B E is the magnetic field intensity, ▽B E Represents vector B E gradient.

[0084] The geomagnetic field disturbance torque on the target spacecraft is:

[0085]

[0086] in, represents the magnetic moment vector matrix of the energized coil in the target spacecraft in the target spacecraft body coordinate system, Representation Matrix Cross product, Represents the rotation matrix from the “CM” orbit coordinate system to the target spacecraft body coordinate system.

[0087] The interference torque in the target spacecraft caused by the misalignment of the mass center of the energized coil and the mass center of the target spacecraft is as follows:

[0088]

[0089] in, Representation Matrix The cross product of It represents the electromagnetic force matrix of the powered coils C1, C2 and C3 in the tracking spacecraft exerted on the powered coil T1 in the target spacecraft in the “CM” orbital coordinate system.

[0090] S3. Establish the orbital dynamics equations of the two spacecraft in the "CM" orbital coordinate system, further obtain the orbital dynamics equations of electromagnetic docking and separation of the spacecraft, establish the attitude dynamics equations of the tracking spacecraft in the tracking spacecraft body coordinate system, and establish the attitude dynamics equations of the target spacecraft in the target spacecraft body coordinate system. The implementation method is as follows:

[0091] S301. In the "CM" orbital coordinate system, the orbital dynamics equations of the tracking spacecraft and the target spacecraft are obtained based on the TH equations. The orbital dynamics model of the spacecraft electromagnetic docking and separation is further obtained by subtracting the two.

[0092] S302. Establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system.

[0093] S303. Establishing the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system.

[0094] In this embodiment, the orbital dynamics model of electromagnetic docking and separation of spacecraft is as follows:

[0095]

[0096] in, represents the position vector of the target spacecraft pointing to the tracking spacecraft in the “CM” orbital coordinate system, express The first-order differential of express The second-order differential of represents the orbital dynamics coefficient matrix, represents the mass of the tracking spacecraft m C and the target spacecraft mass m T The expression of It represents the electromagnetic force exerted on the tracking spacecraft by the target spacecraft, and w0(t) is the nominal interference force on the tracking spacecraft including the interference of the geomagnetic field.

[0097] In the tracking spacecraft body coordinate system, the tracking spacecraft attitude dynamics equation is as follows:

[0098]

[0099] Among them, J C represents the inertia matrix of the tracking spacecraft body, represents the attitude angular velocity of the tracking spacecraft in the tracking spacecraft body coordinate system, express The first-order differential of It represents the total moment acting on the tracking spacecraft in its body coordinate system.

[0100] In the target spacecraft body coordinate system, the target spacecraft attitude dynamics equation is as follows:

[0101]

[0102] Among them, J T represents the inertia matrix of the target spacecraft, represents the attitude angular velocity of the target spacecraft in the target spacecraft body coordinate system, express The first-order differential of It represents the total moment acting on the target spacecraft in its body coordinate system.

[0103] S4. Analyze the multiple coupling effects in the electromagnetic docking and separation system of spacecraft, comprehensively consider the orbital dynamics equations and attitude dynamics equations of electromagnetic docking and separation of spacecraft, and establish an integrated dynamics model of electromagnetic docking and separation of spacecraft. The implementation method is as follows:

[0104] S401. Considering the multiple coupling effects of electromagnetic force, electromagnetic torque and spacecraft attitude integrated motion in the spacecraft electromagnetic docking and separation system, the orbital dynamics linearization equation and attitude dynamics linearization equation of spacecraft electromagnetic docking and separation are established.

[0105] S402. Based on S401, establish the state space form of the integrated dynamic model of the spacecraft electromagnetic docking and separation attitude and orbit.

[0106] In this embodiment, the state space form of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model is as follows:

[0107]

[0108] in, represents the state matrix of the spacecraft electromagnetic docking and separation attitude and orbit integrated system, A represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system matrix, B represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, u(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, Θ represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system interference coefficient matrix, w(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system comprehensive interference matrix.

[0109] S5. By separating the unknown mass characteristic parameters and the eccentricity of the elliptical orbit into comprehensive interference and transforming them into the state space form, the integrated dynamic model of the electromagnetic docking and separation attitude and orbit of the spacecraft is corrected, and the dynamic modeling of the integrated dynamic model of the electromagnetic docking and separation attitude and orbit of the spacecraft under multi-source disturbances such as unknown mass characteristic parameters is realized. The implementation method is as follows:

[0110] S501. Select reference mass characteristic parameters and adopt an approximate linearization method to linearize the orbital dynamics equations of the spacecraft electromagnetic docking and separation in step S301, and separate the eccentricity of the elliptical orbit and the unknown mass parameters into comprehensive interference to obtain the corrected dynamics equations of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model.

[0111] S502. Arrange the corrected dynamic equations of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model to obtain the state space form of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model.

[0112] In this embodiment, the state space model of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model is as follows:

[0113]

[0114] in, represents the state matrix of the spacecraft electromagnetic docking and separation attitude-orbit integrated system after correction, A1 represents the spacecraft electromagnetic docking and separation attitude-orbit integrated system matrix after correction, B1 represents the spacecraft electromagnetic docking and separation attitude-orbit integrated system control input matrix after correction, u1(t) represents the spacecraft electromagnetic docking and separation attitude-orbit integrated system control input matrix after correction, Θ1 represents the interference coefficient matrix of the spacecraft electromagnetic docking and separation attitude-orbit integrated system after correction, w1(t) represents the comprehensive interference matrix of the spacecraft electromagnetic docking and separation attitude-orbit integrated system containing multi-source disturbances such as unknown mass characteristic parameters and elliptical orbit eccentricity.

[0115] Based on the same inventive concept, the present invention also provides a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model building system, including a first model building module, a second model building module and a third model building module.

[0116] Specifically, the first model construction module is used to set the configuration of the power-carrying coils and the magnetic moment vector of the power-carrying coils in the unknown tracking spacecraft and the known target spacecraft, and establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft according to the two magnetic moment vectors of the power-carrying coils and the two configurations of the power-carrying coils; analyze the impact of external interference on electromagnetic docking, and based on the electromagnetic force / torque matrix expression, establish the interference torque matrix expression caused by the non-coincidence between the center of mass of the power-carrying coil and the center of mass of the tracking spacecraft and the target spacecraft.

[0117] The second model building module is used to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system based on the interference moment matrix expression and to establish the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system by using the trajectory linearization method.

[0118] The third model building module is used to analyze the multiple coupling effects of electromagnetic force, electromagnetic torque, relative motion of two spacecraft and attitude motion of spacecraft in the electromagnetic docking and separation system of spacecraft. The state space form of the attitude dynamics equation of tracking spacecraft and the attitude dynamics equation of target spacecraft are merged by approximate linearization method to establish an integrated dynamics model of spacecraft electromagnetic docking and separation attitude and orbit.

[0119] Each module in the above-mentioned spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model modeling system can be fully or partially implemented by software, hardware and their combination. The above-mentioned modules can be embedded in or independent of the processor in the computer device in the form of hardware, or can be stored in the memory of the computer device in the form of software, so that the processor can call and execute the corresponding operations of the above modules.

[0120] Furthermore, the present invention also provides a non-temporary computer-readable storage medium containing instructions, and a computer program is stored on the storage medium. For example, a memory containing instructions, the above instructions can be executed by a processor of a computer device to complete the above method. For example, a non-temporary computer-readable storage medium can be a ROM, a random access memory (RAM), a CD-ROM, a magnetic tape, a floppy disk, and an optical data storage device. When the computer program is executed by the processor, the steps in the example of the method for modeling the integrated dynamic model of the electromagnetic docking and separation attitude and orbit of a spacecraft can be implemented. The specific implementation method can be found in the method embodiment, which will not be repeated here.

[0121] The present invention avoids the plume pollution and docking impact problems caused by the traditional thruster jet docking by proposing a method for electromagnetic docking and separation of spacecraft, clarifies the coupling mechanism between the electromagnetic force, electromagnetic torque and the relative motion of the spacecraft in the attitude-orbit integrated dynamic model of electromagnetic docking and separation of spacecraft, provides an approximate linearization method to deal with the strong nonlinearity and multiple coupling effects of the electromagnetic docking attitude-orbit integrated system, and establishes an attitude-orbit integrated approximate linearization dynamic model under multi-source disturbances such as unknown mass characteristics by separating unknown mass characteristic parameters into comprehensive interference, thereby reducing the complexity of conventional nonlinear coupling models and eliminating the need to identify mass characteristic parameters, laying a foundation for the design of efficient control methods.

[0122] It should be pointed out that the specific implementation methods described above can enable those skilled in the art to understand the invention more comprehensively, but do not limit the invention in any way. Therefore, although the invention has been described in detail in this specification and embodiments, those skilled in the art should understand that the invention can still be modified or replaced by equivalents; and all technical solutions and improvements that do not deviate from the spirit and scope of the invention are included in the protection scope of the patent for the invention. Any figure mark in the claims should not be regarded as limiting the claims involved. Any simple change or equivalent replacement of the technical solution that can be obviously obtained by any technician familiar with the field within the technical scope disclosed in the present invention belongs to the protection scope of the present invention.

Claims

1. A method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model, characterized in that: The following steps are involved: Set the configuration of the energized coils and the magnetic moment vector of the energized coils in the unknown tracking spacecraft and the known target spacecraft, and establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft based on the two energized coil magnetic moment vectors and the two energized coil configurations; analyze the impact of external interference on electromagnetic docking, and based on the electromagnetic force / torque matrix expression, establish the interference torque matrix expression caused by the non-coincidence of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft; Based on the interference moment matrix expression, the trajectory linearization method is used to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system, and the target spacecraft attitude dynamics equation is established in the target spacecraft body coordinate system. The multiple coupling effects of electromagnetic force, electromagnetic torque, relative motion of two spacecraft and attitude motion of spacecraft in the electromagnetic docking and separation system of spacecraft are analyzed. The state space forms of attitude dynamics equations of tracking spacecraft and attitude dynamics equations of target spacecraft are merged by approximate linearization method, and an integrated attitude and orbit dynamics model of spacecraft electromagnetic docking and separation is established.

2. The method for modeling a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics model according to claim 1, characterized in that: The setting of the configuration of the energized coils and the magnetic moment vector of the energized coils in the unknown tracking spacecraft and the known target spacecraft specifically includes the following steps: Establish a local vertical and local horizontal coordinate system with the center of mass "CM" of the tracking spacecraft and the target spacecraft as the origin, and establish a tracking spacecraft body coordinate system and a target spacecraft body coordinate system with the center of mass of the tracking spacecraft and the target spacecraft as the origin and the principal axis of inertia as the coordinate axis; The configuration of the powered coil of the tracking spacecraft (102) in the tracking spacecraft body coordinate system is given, including three powered coils C1 (1021), C2 (1022) and C3 (1023) whose central axes are parallelly distributed, and the position vectors are respectively and The magnetic moment vectors are expressed as: in, To track the magnetic dipole moment of the powered coil C1 in the spacecraft, μ C2 is the magnetic dipole moment of the energized coil C2, μ C3 is the magnetic dipole moment of the energized coil C3; The target spacecraft (103) is provided with a powered coil configuration, including a powered coil T1 (1031) whose center of mass coincides with the target spacecraft. The coordinate vector of the powered coil T1 (1031) in the target spacecraft body coordinate system is: The known magnetic moment vector is 3. The method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model according to claim 1, characterized in that: The method of establishing the matrix form expression of the geomagnetic field interference force / torque caused by the misalignment of the mass center of the energized coil with the mass center of the tracking spacecraft and the target spacecraft comprises the following steps: According to the electromagnetic force / torque magnetic moment vector, the electromagnetic force / torque expression of the electromagnetic coil is constructed. Based on the electromagnetic force / torque expression of the electromagnetic coil, the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft is established in combination with the configuration of the energized coils in the tracking spacecraft and the target spacecraft. Based on the matrix expression of electromagnetic force / torque in the tracking spacecraft and the target spacecraft, the interference force and interference torque of the two spacecraft during the electromagnetic docking process are analyzed, and the matrix expression of the geomagnetic field interference force / torque of the tracking spacecraft and the target spacecraft is established according to the analysis results; Based on the matrix expression of the geomagnetic field interference force / torque on the tracking spacecraft and the target spacecraft, the interference torque caused by the misalignment between the center of mass of the energized coil and the center of mass of the spacecraft is analyzed, and the matrix expression of the interference torque is established.

4. The method for modeling a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics model according to claim 3, characterized in that: It also includes converting the electromagnetic force / torque matrix expression into the electromagnetic force / torque vector expression, as follows: in, To track the position vector from the center of mass of the powered coil in the spacecraft to the center of mass of the powered coil in the target spacecraft, for The unit vector of for The mode of μ0 is the vacuum permeability, is the magnetic moment vector of the energized coil in the target spacecraft, To track the magnetic dipole moments of the powered coils C1, C2, and C3 in the spacecraft, where k = 1, 2, 3; The matrix expression of the electromagnetic force / torque on the target spacecraft is as follows: in, Representation vector The matrix function of Representation vector With vector The function matrix of Representation Matrix Cross product, Representation vector Matrix function of , where k = 1, 2, 3; The geomagnetic field interference force on the target spacecraft is: Among them, B E is the magnetic induction intensity of the Earth's magnetic field, Represents vector B E The gradient of The geomagnetic field disturbance torque on the target spacecraft is: in, represents the magnetic moment vector matrix of the energized coil in the target spacecraft in the target spacecraft body coordinate system, Representation Matrix Cross product, Represents the rotation matrix from the "CM" orbit coordinate system to the target spacecraft body coordinate system.

5. The method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model according to claim 4, characterized in that: The matrix expression of the interference torque caused by the misalignment of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft is: in, Representation Matrix The cross product of It represents the electromagnetic force matrix of the powered coil T1 in the target spacecraft in the "CM" orbital coordinate system subjected to the powered coils C1, C2 and C3 in the tracking spacecraft, represents the rotation matrix from the "CM" orbital coordinate system to the target spacecraft body coordinate system, where k = 1, 2, 3.

6. The method for modeling a spacecraft electromagnetic docking and separation attitude-orbit integrated dynamics model according to claim 5, characterized in that: The method of establishing the attitude dynamics equation of the tracking spacecraft in the tracking spacecraft body coordinate system and the attitude dynamics equation of the target spacecraft in the target spacecraft body coordinate system based on the interference moment matrix expression specifically includes the following steps: In the "CM" orbital coordinate system, the orbital dynamics equations of the tracking spacecraft and the target spacecraft are obtained based on the TH equation. The orbital dynamics model of electromagnetic docking and separation of the spacecraft is obtained by subtracting the orbital dynamics equations of the tracking spacecraft and the target spacecraft: in, represents the position vector of the target spacecraft pointing to the tracking spacecraft in the "CM" orbital coordinate system, express The first-order differential of express The second-order differential of represents the orbital dynamics coefficient matrix, represents the mass of the tracking spacecraft m C and the target spacecraft mass m T The expression of represents the electromagnetic force exerted on the tracking spacecraft by the target spacecraft, w0(t) is the nominal interference force on the tracking spacecraft including the interference of the geomagnetic field; Establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system; Among them, J C represents the inertia matrix of the tracking spacecraft body, represents the attitude angular velocity of the tracking spacecraft in the tracking spacecraft body coordinate system, express The first-order differential of represents the total moment on the tracking spacecraft in its body coordinate system; Establishing the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system; Among them, J T represents the inertia matrix of the target spacecraft, represents the attitude angular velocity of the target spacecraft in the target spacecraft body coordinate system, express The first-order differential of It represents the total moment acting on the target spacecraft in its body coordinate system.

7. The method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model according to claim 6, characterized in that: The integrated dynamic model of the spacecraft electromagnetic docking and separation attitude and orbit is: Among them, X(t) represents the state matrix of the spacecraft electromagnetic docking and separation attitude and orbit integrated system, A represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system matrix, B represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, u(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, Θ represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system interference coefficient matrix, w(t) represents the spacecraft electromagnetic docking and separation attitude and orbit integrated system comprehensive interference matrix.

8. The method for modeling a spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model according to claim 7, characterized in that: It also includes separating unknown mass characteristic parameters into comprehensive interference, and correcting the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model through the comprehensive interference to obtain the state space model of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model, wherein the state space model of the spacecraft electromagnetic docking and separation attitude and orbit integrated dynamics model is: Among them, X1(t) represents the corrected state matrix of the spacecraft electromagnetic docking and separation attitude and orbit integrated system, A1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system matrix, B1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, u1(t) represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system control input matrix, Θ1 represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system interference coefficient matrix, w1(t) represents the corrected spacecraft electromagnetic docking and separation attitude and orbit integrated system comprehensive interference matrix containing multi-source disturbances such as unknown mass characteristic parameters and elliptical orbit eccentricity.

9. A spacecraft electromagnetic docking and separation attitude and orbit integrated dynamic model modeling system, characterized in that: include: The first model building module is used to set the configuration of the energized coils and the magnetic moment vectors of the energized coils in the unknown tracking spacecraft and the known target spacecraft, and establish the electromagnetic force / torque matrix expression in the tracking spacecraft and the target spacecraft according to the two energized coil magnetic moment vectors and the two energized coil configurations; analyze the influence of external interference on electromagnetic docking, and based on the electromagnetic force / torque matrix expression, establish the interference torque matrix expression caused by the non-coincidence of the center of mass of the energized coil with the center of mass of the tracking spacecraft and the target spacecraft; The second model building module is used to establish the tracking spacecraft attitude dynamics equation in the tracking spacecraft body coordinate system and establish the target spacecraft attitude dynamics equation in the target spacecraft body coordinate system based on the interference moment matrix expression by using the trajectory linearization method; The third model building module is used to analyze the multiple coupling effects of electromagnetic force, electromagnetic torque, relative motion of two spacecraft and attitude motion of spacecraft in the electromagnetic docking and separation system of spacecraft. The state space form of the attitude dynamics equation of tracking spacecraft and the attitude dynamics equation of target spacecraft are merged by approximate linearization method to establish an integrated dynamics model of spacecraft electromagnetic docking and separation attitude and orbit.

10. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is loaded by a processor, it is capable of executing the steps of the method for modeling the integrated dynamic model of the attitude and orbit of electromagnetic docking and separation of a spacecraft as described in any one of claims 1 to 8.