A radial posture decoupling control method and system for a magnetically suspended rotating scanning payload

Through the radial posture decoupling control method of magnetic levitation rotation scanning load, the attitude control problem of the load compartment during rapid rotation is solved, high-precision attitude control and imaging quality improvement are achieved, and it is suitable for high-resolution optical remote sensing satellites.

CN114859948BActive Publication Date: 2024-12-06BEIJING INST OF CONTROL ENG
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202210343970.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-03-31
Publication Date
2024-12-06
Estimated Expiration
2042-03-31

AI Technical Summary

Technical Problem

It is difficult for the prior art to realize high-precision attitude control of magnetic levitation rotation scanning satellite loads, especially the interference torque generated during rapid rotation has a great impact on the attitude control of the load compartment and affects the imaging quality.

Method used

A radial posture decoupling control method for magnetic levitation rotary scanning load is designed, through the control force and torque modeling of magnetic bearings, attitude dynamic modeling of load tanks, translational dynamic modeling of two-body system and laser The relative displacement observation at the communications office formulates the load tank direction decoupling control law in the orbital system, realizing the dynamic decoupling control between the load tank and the platform tank.

Benefits of technology

It realizes high-precision attitude control of the load compartment, overcomes the disturbing torque generated by rapid rotation, improves the attitude stability and imaging quality of the load compartment, and provides an optimized control solution for high-resolution optical remote sensing satellites.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114859948B_ABST
    Figure CN114859948B_ABST
Patent Text Reader

Abstract

A radial attitude decoupling control method for a magnetically suspended rotating scanning payload belongs to the field of aerospace control technology. Aiming at a non-ideal rotating scanning rotor (payload cabin) and a satellite platform cabin, the present invention conducts satellite two-body dynamics modeling. In order to achieve high-precision pointing control of the payload cabin by leveraging the platform cabin through a magnetically suspended rotating joint and ensure that the relative linear displacement of the stator and rotor of the laser communication point is zero, an attitude decoupling control law is designed for the magnetically suspended rotating joint. The effectiveness of the model is verified through the joint simulation of the dynamic system and the attitude control system, providing a model reference for the control law design and ground simulation verification of subsequent high-precision attitude control of satellites.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a radial posture decoupling control method and system for a magnetically suspended rotating scanning load, belonging to the technical field of control. Background Art

[0002] Magnetic bearing is a high-performance bearing that uses magnetic field force to suspend the rotor. Because magnetic bearing has many advantages such as no friction, no wear, no lubrication, low cost, low loss, long life, etc., it can be used in a wide range of applications such as high-speed motion occasions and low-speed clean occasions.

[0003] The rotating scanning satellite realizes the intersection of the scanning trajectory and the flight trajectory through the steady-speed rotation of the payload (such as a camera, etc.) through swing scanning, circular scanning (also known as conical scanning), etc., thereby significantly expanding the scanning range of the payload. In the fast scanning imaging or splicing imaging mode of the camera and other payloads, ultra-wide imaging of thousands of kilometers can be achieved. The magnetically levitated rotating scanning satellite can be used for fast, large-scale, high-resolution imaging of high-resolution payloads, etc. It can be used for detailed ground inspections and rapid searches and large-scale tracking of moving targets on the sea, land, and air.

[0004] Applying magnetic suspension bearings to rotating scanning satellites constitutes a magnetic suspension rotating scanning imaging remote sensing satellite, which can realize ultra-wide and high-resolution imaging of remote sensing payloads. The satellite mainly consists of a platform cabin that provides energy, attitude and orbit control, thermal control and other system services, and a payload cabin that mainly consists of a rotating scanning camera and a star sensor. The dynamic and static cabins are softly connected by a magnetic suspension rotating joint, which can not only isolate the broadband disturbance of the platform cabin, but also perform secondary fine-tuning on the position of the payload cabin, so that the pointing of payloads such as cameras has the "super" potential of ultra-precision, ultra-stable, ultra-quiet and ultra-wide, creating a good working environment for payload imaging. At the same time, it can also adjust the relative position between the stator and rotor to ensure fast and effective data transmission of wireless communication.

[0005] (1) Camera optical axis pointing measurement index requirements

[0006] In order to meet the quality requirements of camera rotation imaging, it is necessary to accurately control the direction of the camera; or use data such as the camera's posture to correct the images taken by the camera.

[0007] (2) Laser communication requirements for rotary joints

[0008] The laser transmission receiving and transmitting antennas in the satellite are installed on the rotating joints. During the camera imaging, the laser transmission receiving and transmitting antennas must meet the pointing alignment accuracy requirements: the smaller the displacement deviation, the greater the allowable deflection error. Therefore, controlling the displacement deviation as small as possible will be more conducive to the realization of the load pointing control.

[0009] To this end, the magnetic levitation rotary joint provides precise support and rotation control for the payload cabin. Through the magnetic levitation rotary joint angle (rotary transformer) and displacement (eddy current displacement sensor) measurement components, platform cabin attitude measurement components, and payload cabin attitude measurement components, the accuracy of the load cabin rotation axis pointing control is guaranteed, and high-precision pointing measurement data is provided for the camera optical axis, etc. Therefore, measurement feedback is performed through sensors, signal processing and control signal generation are performed through controllers, and the attitude maneuvering and maintenance of the payload cabin are achieved through the actuation of magnetic bearings.

[0010] In order to transform its "super" potential into "super" capability and ensure the ultra-wide high-resolution imaging of the magnetically suspended rotating scanning satellite, it is necessary to optimize the design of the payload pointing control method and carry out sufficient system performance test verification. The rotating scanning satellite is a multi-body structure composed of a payload cabin and a platform cabin, and the dynamics between them are coupled through the magnetically suspended bearing in the middle; while the payload cabin rotates in the orbital plane, its dynamic model is a multi-degree-of-freedom nonlinear time-varying coupled differential equation group, and the parameters are time-varying functions related to the attitude. Summary of the invention

[0011] The technical problem solved by the present invention is: to overcome the deficiencies of the prior art, to provide a radial attitude decoupling control method for a magnetically levitated rotating scanning payload, to design an attitude control method for a two-body system consisting of a rotating body mainly composed of a payload cabin and a non-rotating body mainly composed of a platform cabin, to design a radial attitude decoupling control law for a magnetically levitated rotating joint, to enable the magnetically levitated rotating joint to borrow force from the platform cabin, to carry out a joint simulation of a dynamic system and an attitude control system, to achieve high-precision attitude control of the payload cabin, and to provide a reference for the control law design and ground simulation verification of high-precision attitude control of subsequent satellites.

[0012] The technical solution of the present invention is: a radial posture decoupling control method of a magnetically suspended rotating scanning load, comprising the following steps:

[0013] (1) Modeling the control force and torque of magnetic bearings;

[0014] The control force and torque modeling of the magnetic bearing includes:

[0015] In the load cabin system, the relationship between the magnetic bearing current and the force and torque it generates is analyzed as follows:

[0016] The force and moment generated by the magnetic bearing in the y direction are as follows:

[0017] The y-direction force generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 is equivalent to the force at the center of mass. and torque as follows:

[0018]

[0019] in, is the installation matrix of the y-axis bearing; is the constitutive model of the y-direction magnetic bearing; represents the driving current of the magnetic bearing M1 in the y direction; represents the driving current of the magnetic bearing M2 in the y direction;

[0020] The forces and moments generated by the magnetic bearing in the z direction are as follows:

[0021] The z-direction force generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 is equivalent to the force at the center of mass. and torque as follows:

[0022]

[0023] in, is the installation matrix of the z-bearing; is the driving matrix of the z-axis magnetic bearing; represents the driving current of the magnetic bearing M1 in the z direction; represents the driving current of the magnetic bearing M2 in the z direction;

[0024] The operating laws of radial magnetic bearings are as follows:

[0025] In the payload cabin body coordinate system, the control currents of the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 are obtained according to the equivalent control force and torque at the required center of mass:

[0026]

[0027] (2) Carry out attitude dynamics modeling of the payload cabin;

[0028] The attitude dynamics modeling of the payload cabin includes:

[0029] In the rotating body coordinate system F ub The attitude dynamics equation of the rotating body is as follows:

[0030]

[0031] in, is the coordinate system F of the rotating body ub The relative derivative of the angular momentum with respect to time; ω ub is the rotating body in the rotating body coordinate system F ub Angular velocity vector inside; represents the angular velocity parameter matrix; H ub is the rotating body in the rotating body coordinate system Fub Angular momentum vector in; M ub is the rotational body's body coordinate system F ub Internal external torque;

[0032] Virtual torque C uib F is the coordinate system of the rotating body ub To the inertial coordinate system F i The coordinate transformation matrix between ubi is the matrix C uib The inverse matrix of

[0033] (3) Perform translational dynamics modeling of a two-body system;

[0034] The two-body system translational dynamics modeling comprises:

[0035] The translational dynamics model of the payload cabin is as follows:

[0036]

[0037] Among them, F uoy is the y control force generated by the magnetic bearing, F uoz is the control force in the z direction generated by the magnetic bearing; m u represents the mass of the rotating body; y uo Represents the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the y-axis direction; z uo Represents the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the z-axis direction;

[0038] The center of mass position relationship between the rotating body and the non-rotating body connected by magnetic levitation is as follows:

[0039]

[0040] in, It represents the displacement of the center of mass of the payload cabin in the y-axis direction of the payload cabin system; It represents the displacement of the mass center of the load cabin in the z-axis direction of the load cabin system; m d Indicates the mass of the platform cabin; It represents the displacement of the center of mass of the platform cabin in the y direction in the load cabin system; It represents the displacement of the center of mass of the platform cabin in the z direction in the load cabin system;

[0041] (5) Observe the relative displacement of the stator and rotor at the laser communication point;

[0042] The observation of the relative displacement of the stator and rotor at the laser communication location comprises:

[0043] The relative displacement of the stator and rotor in the y-axis direction at the laser communication location is:

[0044]

[0045] in, Indicates the axis of the stator and rotor in the laser communication position in the rotating body coordinate system F ub The relative distance in the y direction; L represents the distance between the centers of mass of the rotating body and the non-rotating body; It represents the radial attitude angle of the payload cabin's center of mass in the z direction; h represents the radial attitude angle of the platform cabin mass center in the z direction; dj Represents the distance from the laser communication point to the center of mass of the non-rotating body.

[0046] The relative displacement of the stator and rotor in the z-axis direction at the laser communication location is:

[0047]

[0048] in, It represents the coordinates of the stator and rotor axes in the measuring section of the eddy current displacement sensor w2 in the rotating body coordinate system F ub The relative distance in the z direction; Indicates the radial attitude angle of the payload cabin's center of mass in the y direction; It represents the radial attitude angle in the y direction of the center of mass of the platform cabin;

[0049] (6) Formulate the decoupling control law for the payload module pointing within the orbital system;

[0050] The method of formulating a decoupling control law for the payload cabin pointing within the orbital system includes:

[0051] The forces and moments that control the radial displacement of the laser communication point and the orientation of the payload cabin are as follows:

[0052]

[0053]

[0054] in, and is the control law;

[0055] Payload cabin pitch and yaw attitude Measured in real time by the high dynamic star sensor and gyroscope in the payload cabin; radial relative attitude Obtained through eddy current sensor solution;

[0056] or, The attitude is measured in real time by the very high star sensor and gyroscope in the platform cabin and converted into the rotating body system, and then combined with the attitude measured in the payload cabin. Subtracting them to get the relative posture;

[0057] When the satellite needs to perform attitude or orbit maneuvers, the payload cabin uses relative pointing control, and S = 1;

[0058] When the load rotates stably, the load cabin adopts absolute pointing control, at this time S = 0, the platform cabin adopts follow-up control, and its radial attitude tracks the attitude of the radial corresponding axis of the load cabin. The relationship between the driving current of the magnetic suspension joint and the radial posture at the center of mass of the rotating body is:

[0059]

[0060]

[0061] in, and are all diagonal control matrices; among them, g uy (s) is the translation control law in the y direction; g uz (s) is the translation control law in the z direction; g uθy (s) is the control law for rotation around the y-axis; g uθz (s) is the control law for rotation around the z-axis, and s is a complex variable.

[0062] pass and The relationship between the driving current and the posture signal is SISO, which realizes the decoupling control of the magnetic suspension joint. The decoupling control law is:

[0063]

[0064] A system according to the radial posture decoupling control method of the magnetically suspended rotating scanning payload comprises:

[0065] The first module is used to model the control force and torque of the magnetic bearing;

[0066] The second module is used to model the attitude dynamics of the payload cabin;

[0067] The third module is used to model the translational dynamics of a two-body system;

[0068] The fourth module is used to observe the relative displacement of the stator and rotor at the laser communication location;

[0069] The fifth module is used to formulate the decoupling control law of the payload module pointing within the orbital system.

[0070] A computer-readable storage medium stores a computer program, which, when executed by a processor, implements the steps of the radial posture decoupling control method of the magnetically suspended rotating scanning load.

[0071] A radial posture decoupling control device for a magnetically suspended rotating scanning payload cabin comprises a memory, a processor and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, the steps of the radial posture decoupling control method for the magnetically suspended rotating scanning payload are implemented.

[0072] The advantages of the present invention compared with the prior art are:

[0073] (1) Most existing satellites are integrated structures of payload and platform, or separated satellites and other structures where each cabin has no relative rotational motion. They will not generate large interference torque due to rapid rotation. The rotational inertia of mechanically supported rotating scanning payloads is generally small, and they are basically trimmed and dynamically balanced, so the interference torque generated is small. Moreover, in the past, radar-type payloads were mainly used for rotating scanning, which had low requirements for attitude accuracy and stability. Therefore, the small interference torque can be compensated to a certain extent by the on-board attitude actuator, and the reduction in the accuracy and stability of the payload attitude caused by its residual interference is ignored; the two-cabin rotating scanning satellite with a magnetic levitation rotating joint soft connection involved in the present invention is mainly used for rotating scanning and high-resolution imaging of high-resolution optical remote sensing satellites. Any disturbance of attitude will have a great impact on optical imaging. Therefore, it is necessary to overcome the large interference torque generated by rapid rotation to accurately and stably control the attitude of the payload cabin.

[0074] (2) For satellites with a rigid connection between the payload and the platform, the attitude control of the payload is directly performed through the attitude control system of the platform cabin, while the two-cabin rotating scanning satellite with a soft connection of a magnetic levitation rotating joint involved in the present invention is the first. During the continuous rotation of the rotating body with different rotational inertia of each axis described in the present invention, its inertia changes with time, which will produce interference such as reaction torque and gyroscopic torque of variable inertia. In addition, the present invention is aimed at the dynamic model of the magnetic levitation rotating scanning payload, and realizes the attitude control of the payload cabin by borrowing force from the platform cabin through the magnetic levitation rotating joint. The radial posture decoupling control method of the magnetic levitation rotating scanning payload of the present invention is a decoupling control combined with the two-body translational dynamic characteristics, which is more innovative than the traditional translational decoupling control for the center of mass of a single rigid body. The present invention provides a model basis for the design of high-precision attitude control laws, and also provides a model basis for ground system simulation, laying a theoretical and engineering foundation for model development.

[0075] (3) The two-body attitude simulation of a magnetically suspended asymmetric rotating scanning satellite described in the present invention accurately establishes the dynamic model of the magnetically suspended rotating scanning satellite, and carries out the joint simulation of the control system and the dynamic system, which can be directly applied to model development, especially for the design of high-precision satellite attitude control laws. And because the thrust of the magnetic bearings in this type of magnetically suspended rotating scanning satellite is relatively small, it is difficult to suspend under the action of ground gravity, and therefore ground tests cannot be carried out. This model can simulate the attitude of the system with high precision and verify the implementation of the control law, etc. No additional hardware equipment is required, and it can be directly integrated into the controller at almost no cost; it can be seen that the present invention has direct engineering application value. It provides a basis for realizing ultra-precise, ultra-stable and ultra-quiet control of the payload cabin pointing, and also provides a model basis for ground simulation and ground tests. BRIEF DESCRIPTION OF THE DRAWINGS

[0076] Figure 1 A simplified model of the magnetic levitation rotating scanning satellite system in the present invention;

[0077] Figure 2 It is a technical roadmap for radial posture decoupling control of the magnetically suspended rotating scanning payload in the present invention;

[0078] Figure 3 The simplified model, coordinate system and parameters of the two-body satellite in the present invention;

[0079] Figure 4 It is a block diagram of the radial posture decoupling control system of the magnetically suspended rotating scanning payload in the present invention;

[0080] Figure 5 This is an attitude control simulation example of the magnetically levitated rotating scanning satellite in the present invention. DETAILED DESCRIPTION

[0081] In order to better understand the above technical scheme, the technical scheme of the present application is described in detail below through the accompanying drawings and specific embodiments. It should be understood that the embodiments of the present application and the specific features in the embodiments are detailed descriptions of the technical scheme of the present application, rather than limitations on the technical scheme of the present application. In the absence of conflict, the embodiments of the present application and the technical features in the embodiments can be combined with each other.

[0082] The following is a further description of a radial attitude decoupling control method for a magnetic levitation rotating scanning payload provided in an embodiment of the present application in conjunction with the drawings of the specification. The present invention intends to design a radial attitude decoupling control law for a magnetic levitation rotating joint according to the absolute pointing direction of the magnetic levitation rotating scanning payload. Based on the attitude measured by the payload cabin and the platform cabin and the relative position of the stator and rotor measured by the sensor, the attitude of the magnetic levitation rotating joint and the payload cabin is controlled, and a two-body attitude simulation is performed based on the structural parameters of the satellite. The simplified structural model of the rotating scanning satellite is shown in FIG. Figure 1The flowchart of the two-body posture simulation method provided by the present invention is shown in FIG. Figure 2 As shown, the steps of the two-body two-body attitude simulation method of the magnetic levitation rotating scanning payload cabin are as follows:

[0083] (1) Establishment of the coordinate system of the two-body system

[0084] If the rotor and load cabin of the magnetic levitation rotating joint are regarded as rigid bodies, they constitute a rotating body (or collectively referred to as a load cabin); the stator and platform cabin of the magnetic levitation rotating joint constitute a non-rotating body (or collectively referred to as a platform cabin).

[0085] The coordinate system and related parameters of the magnetically suspended rotating scanning satellite are as follows: Figure 3 shown.

[0086]

[0087]

[0088] (2) Modeling the control force and torque of magnetic bearings

[0089] Figure 3 In the figure, the upper radial magnetic bearing is M1 and the lower radial magnetic bearing is M2. c H represents the axial span between the two magnetic bearings M1 and M2. u1 H represents the distance from the action section of the radial magnetic bearing M1 to the center of mass of the rotating body; u2 It represents the distance H from the action section of the radial magnetic bearing M2 to the center of mass of the rotating body. u2 =H u1 +H c .

[0090] In the rotating body coordinate system F ub The relationship between the magnetic bearing current and the force and torque it generates is as follows:

[0091] The force and torque generated by the magnetic bearing in the y direction:

[0092] The relationship between the y-direction force generated by the magnetic bearings M1 and M2 and their control current is:

[0093]

[0094] in, represents the y-direction force output by the magnetic bearing M1;

[0095] represents the y-direction force output by the magnetic bearing M2;

[0096] represents the driving current of the magnetic bearing M1 in the y direction;

[0097] represents the driving current of the magnetic bearing M2 in the y direction;

[0098] is the constitutive model of the magnetic bearing M1 in the y direction; s is a complex variable;

[0099] It is the constitutive model of the magnetic bearing M2 in the y direction.

[0100] The y-direction force generated by the magnetic bearings M1 and M2 is equivalent to the force and moment at the center of mass:

[0101]

[0102] Among them, the installation matrix of the magnetic bearing in the y direction is:

[0103] The constitutive model matrix of the magnetic bearing in the y direction is:

[0104] Force and torque generated by magnetic bearing in z direction:

[0105] Similarly, the relationship between the z-direction force generated by the magnetic bearings M1 and M2 and their control current is:

[0106]

[0107] in, It represents the z-direction force output by the magnetic bearing M1;

[0108] It represents the z-direction force output by the magnetic bearing M2;

[0109] represents the driving current of the magnetic bearing M1 in the z direction;

[0110] represents the driving current of the magnetic bearing M2 in the z direction;

[0111] is the constitutive model of the magnetic bearing M1 in the z direction;

[0112] It is the constitutive model of the magnetic bearing M2 in the z direction.

[0113] The z-direction force generated by the magnetic bearings M1 and M2 is equivalent to the force and moment at the center of mass:

[0114]

[0115] Among them, the installation matrix of the magnetic bearing in the z direction is:

[0116] The constitutive model matrix of the magnetic bearing in the z direction is: Operating laws of radial magnetic bearings:

[0117] Then the model between the magnetic bearing control current and the control force and torque equivalent to the center of mass is:

[0118]

[0119] It can be seen that in the payload cabin body coordinate system, the control currents of the magnetic bearings M1 and M2 can be obtained according to the equivalent control force and torque at the required center of mass.

[0120] (3) Carry out attitude dynamics modeling of the payload cabin

[0121] Newtonian mechanics is based on an inertial system, so there is a relationship in the inertial system according to the angular momentum theorem:

[0122]

[0123] in, M is the external torque vector acting on the rotating body; ui is the external torque vector In the inertial coordinate system F i The vector inside;

[0124] is the angular momentum vector of the rotating body; H ui is the angular momentum vector In the inertial coordinate system F i The vector inside;

[0125] is the rotating body in the inertial coordinate system F i The angular momentum vector H ui The derivative with respect to time (absolute rate of change);

[0126] ω ui is the rotating body in the inertial coordinate system F i The angular velocity vector inside.

[0127] The above inertial coordinate system F i The dynamic model is transformed into the rotating body coordinate system F ub Inside:

[0128]

[0129] Among them, H ub is the rotating body in the rotating body coordinate system F ub The angular momentum vector in ;

[0130] ω ub is the rotating body in the rotating body coordinate system F ub Angular velocity vector inside;

[0131] represents the angular velocity parameter matrix;

[0132] is the angular momentum vector H of the rotating body ub The derivative with respect to time (relative rate of change).

[0133] C uib F is the coordinate system of the rotating body ub To the inertial coordinate system F i The coordinate transformation matrix between .

[0134] It can be seen that the attitude dynamics in the non-inertial system is directly related to the coordinate transformation relationship from the inertial system to the current system. The dynamic adaptability conditions caused by this coordinate transformation relationship are analyzed below.

[0135] The star is in small angle rotation mode:

[0136] If the star body rotates at a small angle, the coordinate transformation matrix C uib The off-diagonal elements of are small, that is, C uib Approximately the unit matrix, then At this time, formula (7) can be simplified as follows:

[0137]

[0138] That is, the posture dynamics equation in the body coordinate system. Given the coordinate transformation matrix C uib Reversible, so:

[0139]

[0140] It can be seen that when the star rotates at a small angle, the attitude dynamics can be calculated in the body coordinate system. The star is in a large angle rotation mode:

[0141] When the star body rotates at a large angle, the coordinate transformation matrix C uib is no longer approximately the unit matrix, so now In this case, the dynamic model of formula (7) is transformed into:

[0142]

[0143] It can be seen that the stellar dynamics (9) in the small-angle rotation mode is just a special case of the stellar dynamics (10) in the large-angle rotation mode, and therefore (10) has more general applicability.

[0144] Furthermore, the additional term caused by rotation in the dynamic equation is taken as a virtual torque:

[0145]

[0146] At this time, the torque on the right side of (10) becomes It can be used to rotate the body coordinate system F ub Inside.

[0147] In the rotating body coordinate system F ub The posture dynamics equation of the internal rotation body:

[0148]

[0149] It can be seen that appropriate correction terms need to be added when rotating within a large angle range. The dynamic model after adding the correction terms can be used as the object model of attitude control of the magnetically levitated rotating scanning satellite in this system.

[0150] (4) Modeling the translational dynamics of a two-body system

[0151] Load cell translational dynamics modeling:

[0152] According to the force analysis of the magnetic bearing, it can be known that in the rotating body orbital coordinate system F uo The control forces in the y and z directions generated by the magnetic bearings [F uoy F uoz ] T (acting on the load compartment) is:

[0153]

[0154] in, is the coordinate system F of the rotating body ub To the inertial coordinate system F o There is a coordinate rotation matrix in memory. ω ux is the rotational angular velocity of the payload cabin, and t is the time;

[0155] For the load and joint rotor system, if the structural damping is not considered, the radial translation dynamic equation is:

[0156]

[0157] The relative translation relationship between the two body mass centers is:

[0158] Since the angular speed and relative linear velocity of the two bodies are both small, the Coriolis force is temporarily ignored in the present invention. It is assumed that the connection between the load cabin and the platform cabin has only the Lorentz force of the magnetic bearing, but no damping force. e Provides the normal acceleration a of the entire star n, that is, changing the direction of the satellite's speed, that is, (m u +m d ) n =G e . and m u Represents the mass of the rotating body; m d Indicates the mass of the non-rotating body. In addition, the external forces on the star in the y and z directions of the orbital coordinate system are zero. Therefore, according to the momentum theorem of the particle system, the dynamic model of the center of mass of the two cabins of the magnetic levitation rotating scanning satellite in the radial direction is established as follows:

[0159]

[0160] Among them, y uo Represents the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the y-axis direction;

[0161] z uo Represents the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the z-axis direction;

[0162] y do Denotes the center of mass of the non-rotating body relative to the orbital coordinate system F o Displacement in the y-axis direction.

[0163] z do Denotes the center of mass of the non-rotating body relative to the orbital coordinate system F o Displacement in the z-axis direction;

[0164] y co It represents the mass center of the whole star relative to the orbital coordinate system F o The offset in the y-axis direction;

[0165] z co It represents the mass center of the whole star relative to the orbital coordinate system F o The offset in the z-axis direction.

[0166] From this we can solve: co (t) = 0; z co (t) = 0, indicating that the combined center of mass of the two bodies is stationary, and there exists:

[0167]

[0168] The center-of-mass position relationship between the rotating body and the non-rotating body of the magnetic levitation connection can be solved by equation (16):

[0169]

[0170] The above equation reflects the relative motion relationship between the center of mass of the load cabin and the platform cabin that are not subject to external forces. Further, both sides are multiplied by the inertial coordinate system Fo To the rotating body coordinate system F ub Coordinate rotation matrix exists in memory Then we get:

[0171]

[0172] in, It represents the displacement of the center of mass of the payload cabin in the y-axis direction of the payload cabin system; It represents the displacement of the center of mass of the payload cabin in the z-axis direction of the payload cabin system; It represents the displacement of the center of mass of the platform cabin in the y direction in the load cabin system; It represents the displacement of the center of mass of the platform cabin in the z direction in the load cabin system.

[0173] It can be seen from this that the motion relationship between the center of mass of the payload cabin and the platform cabin, which are not subject to external forces, in the payload cabin body coordinate system is basically consistent with that in the orbital coordinate system.

[0174] (5) Observation of relative displacement between stator and rotor at laser communication

[0175] Figure 3 In the figure, the upper radial eddy current sensor is W1, and the lower radial eddy current sensor is W2. w Represents the axial span between the two radial eddy current sensors W1 and W2.

[0176] h u1 h represents the distance from the measuring section of the upper radial eddy current sensor W1 to the center of mass of the rotating body; u2 The distance h from the measuring section of the lower radial eddy current sensor W2 to the center of mass of the rotating body is u2 =h u1 +h w ;h uj Indicates the distance from the laser communication point to the center of mass of the rotating body;

[0177] h d2 h represents the distance from the measuring section of the lower radial eddy current sensor W2 to the center of mass of the non-rotating body; d1 It represents the distance h from the measuring section of the upper radial eddy current sensor W1 to the center of mass of the non-rotating body. d1 =h d2 +h w ;h dj It represents the distance from the laser communication point to the center of mass of the non-rotating body;

[0178] Let L represent the distance between the centers of mass of the rotating body and the non-rotating body, then there is a relationship:

[0179] Translation and radial attitude angle of the center of mass of the payload cabin and the translation and radial attitude angle of the center of mass of the platform cabin The y-direction displacement of the two sets of radial eddy current sensors caused by this is:

[0180]

[0181] in, It represents the offset of the measurement center of the eddy current sensor W1 in the y direction caused by the deflection of the load compartment;

[0182] It represents the offset of the measurement center of the eddy current sensor W2 in the y direction caused by the deflection of the load compartment;

[0183] Indicates the offset of the laser communication in the y direction caused by the deflection of the payload cabin;

[0184] It represents the offset of the measurement center of the eddy current sensor W1 in the y direction caused by the deflection of the platform cabin;

[0185] It represents the offset of the measurement center of the eddy current sensor W2 in the y direction caused by the deflection of the platform cabin;

[0186] It represents the offset of laser communication in the y direction caused by the deflection of the platform cabin;

[0187] Represents the rotation of the body around the body coordinate system F ub The yaw angle of the z-axis;

[0188] Represents the coordinate system F of the non-rotating body around the rotating body ub The yaw angle of the z-axis.

[0189] Then the translation of the center of mass of the payload cabin and the radial attitude angle and the translation and radial attitude angle of the center of mass of the platform cabin The z-direction displacement of the two sets of eddy current sensors caused by this is:

[0190]

[0191] in, It represents the offset of the measurement center of the eddy current sensor W1 in the z direction caused by the deflection of the load compartment;

[0192] It represents the offset of the measurement center of the eddy current sensor W2 in the z direction caused by the deflection of the load compartment;

[0193] Indicates the offset of the laser communication in the z direction caused by the deflection of the payload cabin;

[0194] It represents the offset of the measurement center of the eddy current sensor W1 in the z direction caused by the deflection of the platform cabin;

[0195] It represents the offset of the measurement center of the eddy current sensor W2 in the z direction caused by the deflection of the platform cabin;

[0196] It represents the offset of the laser communication in the z direction caused by the deflection of the platform cabin;

[0197] Represents the rotation of the body around the body coordinate system F ub The pitch angle of the y-axis;

[0198] Represents the coordinate system F of the non-rotating body around the rotating body ub The pitch angle of the y-axis.

[0199] Assumptions It represents the coordinate system F of the stator and rotor axes in the measurement section of the eddy current displacement sensor w1. ub The relative distance in the y direction; It represents the coordinates of the stator and rotor axes in the measuring section of the eddy current displacement sensor w2 in the rotating body coordinate system F ub The relative distance in the y direction; Indicates the axis of the stator and rotor in the laser communication position in the rotating body coordinate system F ub The relative distance in the y direction. Then the relative displacement of the measurement section of the eddy current displacement sensors w1 and w2 and the stator and rotor axis in the laser communication caused by the center of mass movement and deflection is and It can be calculated by formula (19):

[0200]

[0201] Assumptions It represents the coordinate system F of the stator and rotor axes in the measurement section of the eddy current displacement sensor w1. ub The relative distance in the z direction; It represents the coordinates of the stator and rotor axes in the measuring section of the eddy current displacement sensor w2 in the rotating body coordinate system F ub The relative distance in the z direction; It represents the coordinates of the stator and rotor axes in the measuring section of the eddy current displacement sensor w2 in the rotating body coordinate system F ubThe relative distance in the z direction. Then the relative displacement of the stator and rotor axes in the laser communication caused by the mass center movement and deflection of the eddy current displacement sensors w1 and w2 is and It can be calculated by formula (20):

[0202]

[0203] From formula (21), we can get:

[0204]

[0205] Therefore, the relative displacement in the y-axis direction at the laser communication point is:

[0206]

[0207] Among them, h d1j h represents the distance from the measuring section of the upper radial eddy current sensor W1 to the laser communication point; dj2 represents the distance from the laser communication point to the measuring section of the lower radial eddy current sensor W2; then there is a relationship: h d1j =h d1 -h dj ;h dj2 =h dj -h d2 The theoretical value of the relative displacement at the laser communication point estimated by the model is the feedback signal for the following controller design, while the relative displacement at the laser communication point estimated by the sensor is the feedback signal for the actual operation. Formula (22) can be solved as follows:

[0208]

[0209] Therefore, the relative displacement in the z-axis direction at the laser communication point is:

[0210]

[0211] The above formula reflects the relative displacement of the stator and rotor axes within the laser communication section caused by the radial motion of the two bodies.

[0212] (6) Formulate the decoupling control law for the payload cabin pointing within the orbital system

[0213] In view of the constraints on the relative motion of the joint stator and rotor due to laser communication, the radial displacement of the laser communication point is controlled, and the direction of the load cabin (including absolute direction and relative direction) is controlled. The force and torque are:

[0214]

[0215]

[0216] in, and is the control law. The pitch and yaw attitude of the payload cabin It can be measured in real time by its high dynamic star sensor and gyroscope; and the radial relative attitude It can be solved by eddy current sensors; it can also be obtained by measuring the attitude in real time through the very high star sensor and gyroscope of the platform cabin, and converting it into the rotating body system, and then combining it with the attitude measured by the above-mentioned payload cabin, and subtracting them to obtain the relative attitude. When the satellite needs to perform attitude or orbit maneuvers, the payload module adopts relative pointing control (S=1).

[0217] When the payload rotates stably, the payload cabin adopts absolute pointing control (S=0), while the platform cabin adopts follow-up control, and its radial attitude tracks the attitude of the radial corresponding axis of the payload cabin.

[0218] Obviously, the latter is the normal state of satellite operation. In this normal working condition, the radial translation and rotational dynamics of the rotating body are decoupled, and the radial translation and rotational feedback signals are also decoupled, and the actuator control law of the magnetic bearing is also decoupled. It can be seen that by designing the decoupling control law, the attitude decoupling control of the system can be achieved.

[0219] Under the master-slave cooperative control of the payload cabin (pointing control) and the platform cabin (attitude tracking control), S = 0, and That is, when the platform cabin tracks the radial attitude of the payload cabin well, equations (27) and (28) can be simplified to:

[0220]

[0221]

[0222] Then the relationship between the driving current of the magnetic levitation joint and the radial posture at the center of mass of the rotating body is:

[0223]

[0224]

[0225] in, and are all designable diagonal control matrices, where g uy (s) is the translation control law in the y direction; g uz (s) is the translation control law in the z direction; g uθy (s) is the control law for rotation around the y-axis; g uθz (s) is the control law for rotation around the z-axis, and s is a complex variable.

[0226] It can be obtained that the decoupling control law of the magnetic suspension rotary joint is:

[0227]

[0228] because and They are all diagonal matrices. Through equations (31) and (32), we can get that the driving current and the posture signal are SISO (single input single output), realizing the decoupling control of the magnetic levitation joint.

[0229] The radial attitude decoupling control law obtained by the method of the present invention is verified by performing vertical orbit scanning satellite attitude simulation:

[0230] Figure 4 It is a block diagram of the radial posture decoupling control system of the magnetically suspended rotating scanning payload in the present invention;

[0231] The rotation scanning imaging of the payload cabin mainly includes vertical track scanning, circular scanning (or conical scanning) and along-track scanning (spinning satellite scanning mode). The present invention takes the first vertical track scanning as an example for simulation analysis. The payload cabin rotates around the x-axis in the flight direction. In view of the fact that the attitude control is carried out in the orbital system, the control target is the attitude stability relative to the orbital system, or more precisely, the attitude stability control relative to the nominal rotating coordinate system of the orbit. For the payload in any rotation scanning period (with the zero phase in one period as the timing starting point), the attitude change caused by the orbital rotation in the inertial system is very small (rotation scanning period <1% orbital period), then at any attitude control moment, its C uib =C uio C uob ≈C uob According to the star layout, the following parameters can be temporarily taken:

[0232] h 1u =1.291; h 2u =1.577; h 1d =0.742; h 2d =0.456; h uj =1.191; h dj =0.842;

[0233] According to the design parameters of the magnetic bearing, it is preliminarily assumed that the model of the radial magnetic bearing is the same, which is:

[0234]

[0235] When the load cabin is subjected to various interference torques and dynamic unbalance, a collaborative control strategy based on the load cabin is adopted. and All adopt PID control method, and each transmission is: The initial value of PID control parameter can be taken as: k P =1000; k I =100; k D =1. At the same time, the platform cabin attitude controller also adopts PID control, and the dynamics and control system simulation of the two-cabin system is carried out using Simulink. The simulation results are as follows Figure 5 shown.

[0236] Through the coordinated control of the attitude of the magnetic levitation rotary joint and the platform cabin, high-precision attitude control of the two cabins is achieved, and the relative attitude relationship of the stator and rotor required for wireless communication is guaranteed. The dynamic model established by the present invention is a reference for the satellite, including the payload cabin pointing control based on the magnetic levitation rotary joint and the platform cabin attitude control, and is also the basis for the ground system dynamics simulation, providing a basis for the ultra-precise, ultra-stable and ultra-static attitude control of the payload cabin.

[0237] The control system according to the radial posture decoupling control method of the magnetic levitation rotating scanning load comprises:

[0238] The first module is used to model the control force and torque of the magnetic bearing;

[0239] The second module is used to model the attitude dynamics of the payload cabin;

[0240] The third module is used to model the translational dynamics of a two-body system;

[0241] The fourth module is used to observe the relative displacement of the stator and rotor at the laser communication location;

[0242] The fifth module is used to formulate the decoupling control law of the payload module pointing within the orbital system.

[0243] A computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, steps (1) to (6) of the radial posture estimation method of the magnetic levitation rotating scanning payload cabin are implemented.

[0244] A radial posture decoupling control device for a magnetically suspended rotating scanning payload cabin comprises a memory, a processor and a computer program stored in the memory and executable on the processor. When the processor executes the computer program, steps (1) to (6) of the radial posture estimation method for the magnetically suspended rotating scanning payload cabin are implemented.

[0245] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage and optical storage, etc.) that contain computer-usable program code.

[0246] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0247] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0248] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0249] Obviously, those skilled in the art can make various changes and modifications to the present application without departing from the spirit and scope of the present application. Thus, if these modifications and variations of the present application fall within the scope of the claims of the present application and their equivalents, the present application is also intended to include these modifications and variations.

[0250] The contents not described in detail in the specification of the present invention belong to the common knowledge of those skilled in the art.

Claims

1. A radial posture decoupling control method for a magnetically suspended rotating scanning payload, characterized in that: include: Modeling of control forces and torques of magnetic bearings; Carry out attitude dynamics modeling of the payload cabin; Perform translational dynamics modeling of a two-body system; Observe the relative displacement of the stator and rotor at the laser communication point; Formulate the decoupling control law for the payload module pointing within the orbital system; The method of formulating a decoupling control law for the payload cabin pointing within the orbital system includes: The forces and moments that control the radial displacement of the laser communication point and the orientation of the payload cabin are as follows: in, and is the control law; When the satellite needs to perform attitude or orbit maneuvers, the payload cabin uses relative pointing control, and S = 1; When the load rotates stably, the load cabin adopts absolute pointing control, at this time S = 0, the platform cabin adopts follow-up control, and its radial attitude tracks the attitude of the radial corresponding axis of the load cabin. The relationship between the driving current of the magnetic suspension joint and the radial posture at the center of mass of the rotating body is: in, and are all diagonal control matrices; among them, g uy (s) is the translation control law in the y direction; g uz (s) is the translation control law in the z direction; g uθy (s) is the control law for rotation around the y-axis; g uθz (s) is the control law for rotation around the z-axis; s is a complex variable; pass and The relationship between the driving current and the posture signal is SISO, which realizes the decoupling control of the magnetic suspension joint. The decoupling control law is: In the above formula, and torque are the forces and moments in the y direction generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2, which are equivalent to the forces and moments at the center of mass; and The z-direction forces generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 are equivalent to the forces and moments at the center of mass; m u Represents the mass of the rotating body; m d Indicates the mass of the platform cabin; It represents the displacement of the center of mass of the payload cabin in the y-axis direction of the payload cabin system; It represents the displacement of the center of mass of the payload cabin in the z-axis direction of the payload cabin system; It represents the radial attitude angle of the payload cabin's center of mass in the z direction; It represents the radial attitude angle in the z direction of the center of mass of the platform cabin; Indicates the radial attitude angle of the payload cabin's center of mass in the y direction; h represents the radial attitude angle of the platform cabin mass center in the y direction; dj It represents the distance from the laser communication point to the center of mass of the non-rotating body; L represents the distance between the centers of mass of the rotating body and the non-rotating body; is the constitutive model matrix of the y-axis magnetic bearing; represents the driving current of the magnetic bearing M1 in the y direction; represents the driving current of the magnetic bearing M2 in the y direction; is the constitutive model matrix of the z-direction magnetic bearing; represents the driving current of the magnetic bearing M1 in the z direction; represents the driving current of the magnetic bearing M2 in the z direction; is the installation matrix of the z-bearing; is the installation matrix of the y-axis bearing.

2. The radial posture decoupling control method of a magnetically suspended rotating scanning payload according to claim 1 is characterized in that: The control force and torque modeling of the magnetic bearing includes: In the load cabin system, the relationship between the magnetic bearing current and the force and torque it generates is analyzed as follows: The force and moment generated by the magnetic bearing in the y direction are as follows: The y-direction force generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 is equivalent to the force at the center of mass. and torque as follows: in, is the installation matrix of the y-axis bearing; is the constitutive model matrix of the y-axis magnetic bearing; represents the driving current of the magnetic bearing M1 in the y direction; represents the driving current of the magnetic bearing M2 in the y direction; The force and torque generated by the magnetic bearing in the z direction are as follows: The z-direction force generated by the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 is equivalent to the force at the center of mass. and torque as follows: in, is the installation matrix of the z-bearing; is the constitutive model matrix of the z-direction magnetic bearing; represents the driving current of the magnetic bearing M1 in the z direction; represents the driving current of the magnetic bearing M2 in the z direction; The operating laws of radial magnetic bearings are as follows: In the payload cabin body coordinate system, the control currents of the upper radial magnetic bearing M1 and the lower radial magnetic bearing M2 are obtained according to the equivalent control force and torque at the required center of mass:

3. The radial posture decoupling control method of a magnetically suspended rotating scanning payload according to claim 1 is characterized in that: The attitude dynamics modeling of the payload cabin includes: In the rotating body coordinate system F ub The attitude dynamics equation of the rotating body is as follows: in, is the coordinate system F of the rotating body ub The relative derivative of the angular momentum with respect to time; ω ub is the rotating body in the rotating body coordinate system F ub Angular velocity vector inside; represents the angular velocity parameter matrix; H ub is the rotating body in the rotating body coordinate system F ub Angular momentum vector in; M ub is the rotational body's body coordinate system F ub Internal external torque; Virtual torque C uib F is the coordinate system of the rotating body ub To the inertial coordinate system F i The coordinate transformation matrix between ubi is the matrix C uib The inverse matrix of .

4. The radial posture decoupling control method of a magnetically suspended rotating scanning payload according to claim 1 is characterized in that: The two-body system translational dynamics modeling comprises: The translational dynamics model of the payload cabin is as follows: Among them, m u Indicates the mass of the rotating body; F uoy is the y control force generated by the magnetic bearing, F uoz is the control force in the z direction generated by the magnetic bearing; uo Denotes the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the y-axis direction; z uo Represents the center of mass of the rotating body relative to the orbital coordinate system F o Displacement in the z-axis direction; The center of mass position relationship between the rotating body and the non-rotating body connected by magnetic levitation is as follows: Among them, m d Indicates the mass of the platform cabin; It represents the displacement of the center of mass of the payload cabin in the y-axis direction of the payload cabin system; It represents the displacement of the center of mass of the payload cabin in the z-axis direction of the payload cabin system; It represents the displacement of the center of mass of the platform cabin in the y direction in the load cabin system; It represents the displacement of the center of mass of the platform cabin in the z direction in the load cabin system.

5. The radial posture decoupling control method of a magnetically suspended rotating scanning payload according to claim 4 is characterized in that: The observation of the relative displacement of the stator and rotor at the laser communication location comprises: The relative displacement of the stator and rotor in the y-axis direction at the laser communication location is: in, Indicates the axis of the stator and rotor in the laser communication position in the rotating body coordinate system F ub The relative distance in the y direction; L represents the distance between the centers of mass of the rotating body and the non-rotating body; It represents the radial attitude angle of the payload cabin's center of mass in the z direction; h represents the radial attitude angle of the platform cabin mass center in the z direction; dj It represents the distance from the laser communication point to the center of mass of the non-rotating body; The relative displacement of the stator and rotor in the z-axis direction at the laser communication location is: in, It represents the coordinates of the stator and rotor axes in the measuring section of the eddy current displacement sensor w2 in the rotating body coordinate system F ub The relative distance in the z direction; Indicates the radial attitude angle of the payload cabin's center of mass in the y direction; It represents the radial attitude angle in the y direction of the center of mass of the platform cabin.

6. The radial posture decoupling control method of a magnetically suspended rotating scanning payload according to claim 1, characterized in that: The formulating of the decoupling control law for the payload cabin pointing in the orbit system also includes: Payload cabin pitch and yaw attitude Measured in real time by the high dynamic star sensor and gyroscope in the payload cabin; radial relative attitude Obtained through eddy current sensor solution; or, The attitude is measured in real time by the very high star sensor and gyroscope in the platform cabin and converted into the rotating body system, and then combined with the attitude measured in the payload cabin. and Subtracting them yields the relative attitude.

7. A system according to any one of claims 1 to 6, wherein the radial posture decoupling control method of the magnetically suspended rotating scanning load is characterized in that: include: The first module is used to model the control force and torque of the magnetic bearing; The second module is used to model the attitude dynamics of the payload cabin; The third module is used to model the translational dynamics of a two-body system; The fourth module is used to observe the relative displacement of the stator and rotor at the laser communication location; The fifth module is used to formulate the decoupling control law of the payload module pointing within the orbital system.

8. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 6 are implemented.

9. A radial posture decoupling control device for a magnetically suspended rotating scanning payload compartment, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 6 are implemented.

Citation Information

Patent Citations

  • Rotary load smooth control method based on magnetic suspension bearing active stiffness regulation

    CN110045744A

  • Attitude control method for platform follow-up rotating load satellite centered on load

    CN110147115A

  • Method and system for estimating disturbance torque caused by asymmetric rotational scanning load

    CN113031668A

  • Radial pose estimation method and system for magnetic suspension rotary scanning load cabin

    CN113091729A